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FOREWORD 



This document constitutes the TRW Defense and Space Systems Group final 
technical report to NASA Langley Research Center for the Application of Pre- 
cision Attitude Determination Systems to the Earth Resources Survey (AAFE) 
Program. Prepared under NASA contract NASl-12894, the report is being pre- 
sented in two volumes, of which this is Volume II: 

t Volume I - Strapdown Star Tracker Development 

• Volume II — System Tests. 

This report reflects the contributions of a number of previous efforts 
performed both under NASA contract {NAS5-21111) and independently by TRW. 

In the area of system design and analysis these efforts are summarized in 
the following final technical reports: 

• PPCS System Design and Analysis, 1 3900-601 2-RO-Ol , 

NASA/GSFC, NAS5-21in, 1 July 1972. 

• PADS System Design and Analysis (Two-Axis Gimbal Star 
Tracker), 1 3900-601 4-RU-OO, NASA/GSFC, NAS5-21111, 

1 July 1973. 

• PADS System Design and Analysis (Single-Axis Gimbal Star 
Tracker), 13900-601 6-RU-OO, NASA/GSFC, NAS5-21111, 

1 July 1974. 

• PADS System Design and Analysis (Strapdown Star Tracker), 

99994-631 6-RU-OO, TRW Report, 23 December 1975. 

In the area of hardware development the following reports have been 
publ ished: 

• PPCS Star Tracker Test, 13900-601 3 -RU -00, NASA/GSFC, 

NAS5-2im, 1 July 1972. 

• PADS Star Tracker Test, 13900-601 5-RU-OO, NASA/GSFC, 

NAS5-21111, 1 July 1973. 

TRW employees who contributed to this final report Include: F.J.Belsky, 
D.I. Brubaker, R.E. Edwards, R.L. Farrenkopf, R.F. Gates, R.J. Mann, 

K.J. McAloon, and J.G. Zaremba. 

Approved by: 

Project Manager 


Approved by: 
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1 . INTRODUCTION AND SUMMARY 


Since 1970 TRW has been engaged in activities related to precision 
attitude determination systems (PADS) for spacecraft applications under 
company, NASA, and USAF funding. In addition to extensive analyses of 
such systems, developmental efforts have been undertaken in the areas of 
star trackers and software algorithms. Engineering model gimbal and 
strapdown star trackers were developed and tested along with computer 
simulations of the effectiveness of various algorithm approaches. 

In 1974 NASA/LaRC awarded TRW a contract to perform a laboratory 
test of the performance capability of an engineering model PADS. The 
test objective which evolved subsequently was to test two such systems, 
one using a strapdown star tracker, the other using a single-axis gimbal 
star tracker. The simulated orbit configuration was to be that of a PADS 
aboard a three-axis stabilized, earth-pointed satellite in geosynchronous 
orbit. The performance goal was to demonstrate 0.001 degree (la) per axis 
accuracy for both the strapdown and gimbal PADS. A secondary program 
objective was the fabrication, assembly, and unit test of the strapdown 
star tracker ■<'or the system test. The majority of the design of this 
tracker had already been accomplished. 

A functional block diagram of PADS is presented in Figure 1-1. PADS, 
mounted aboard a spacecraft, provides estimates of the inertial attitude 
of the spacecraft aXes. The PADS sensors are: 

e A star tracker which provides periodic updates of the 
spacecraft attitude relative to identified stars. 

9 Gyros which provide a continuous indication of the 
relative inertial attitude of the spacecraft. 

In addition to the sensors, a digital computer (either on-board or ground- 
based) implements the software algorithms which combine the redundant 
sensor signals and compute the spacecraft inertial attitude. 
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ALGORITHMS 

Figure 1-1. Precision Attitude Determination System (PADS) 

The PADS engineering model hardware components tested in the labora- 
tory are shown in Figure 1-2. These components consist of: 

9 A strapdown star tracker developed by TRW 

0 A single-axis gimbal star tracker also developed by TRW 

« A three-axis inertial reference unit furnished by NASA. 


The PADS software algorithms were implemented offline in a CDC 6500 digital 
computer. 

In orbit the strapdown star tracker uses the orbit rate of the satel- 
lite for star availability. The developed strapdown star tracker has a 
star magnitude sensitivity requirement of 8 in order to provide frequent 
star updates at geosynchronous rate. A small 1° by l'^ field of view 
resulted from the accuracy requirement of 0.001 degree. 

The single-axis gimbal star tracker is a modification of a two-axis 
tracker developed by TRW on a USAF program. In its modified state it has 
a 1/2° by 1/2° field of view which can be gimbaled through ±45°. In view 
of the larger effective field of view of the tracker, its star magnitude 
sensitivity requirement is only 3.5 M^. 

The original intent was that NASA would furnish an engineering model 
of a th»*ee-axis inertial reference assembly using the Bendix 64 PM RIG 
gyro. However, schedule difficulties precluded delivery of this assembly, 
and the engineering model Inertial Reference Unit (IRU) from the Orbiting 
Astronomical Observatory program was substituted. Although nominally a 
higher performance unit, a somewhat anomalous behavior of the IRU gyros 
resulted in it being roughly equivalent to the Bendix specified performance. 


1-2 




STRAPDOWN 
STAR TRACKER 


OAO IRU 

ENGINEERING MODEL 


GYROS 





Since the primary emphasis of the laboratory evaluation was on the 
accuracy of the star trackers and the effectiveness of the software algo- 
rithms in processing actual sensor signals, it was considered adequate to 
implement the algorithms offline in a CDC 6500 digital computer. The 
sensor signals were time-tagged and stored on magnetic tape during the 
test, and then processed post-test using FORTRAN coded algorithms. 

The precision test facility in which the PADS tests were performed is 
shown in Figure 1-3. A ground-fixed test configuration was implemented 
both because of the geosynchronous orbit simulation requirement and the 
extremely high accuracy demanded from the laboratory instrumentation. In 
this configuration the PADS reference axes were stationary in the laboratory 
axes and the collimated star beams were moved relative to the laboratory, 
or PADS, axes. Knowledge of the inertial motion of the laboratory, plus 
measurement of the attitude of the star beams relative to the laboratory 
axes by laboratory instrumentation, provided the reference coordinates 
against which the PADS attitude estimates were compared. 

Both the strapdown and gimbal PADS laboratory tests were successfully 
completed. In each case a ten day test was performed following an initial 
alignment procedure. During the ten days four evenly spaced attitude 
determination test runs were made. Each run was four to five hours long. 

Post-test data processing and evaluation showed that both systems met 
the performance goal of 0.001 degree (lo) per axis. Based on star avail- 
ability data, 20 minute star update intervals were selected to minimize gyro 
induced errors while still providing a high probability (>97%) of star 
acquisition. The rms accuracy obtained with each system, normalized to 
equal components for all axes, was: 

8 Strapdown PADS: 2,3 arc second (rms) per axis 

8 Gimbal PADS: 3.6 arc second (rms) per axis. 

These results were obtained without any limitations in star separation 
geometry. 

In view of the test results obtained, the program was considered very 
successful, not only because a difficult laboratory evaluation was completed 
as planned, but because both PADS met their performance goals. 
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2. TEST OBJECTIVE 


The purpose of the PADS system tests was to measure the performance 
capability of each of two PADS, one using a strapdown star tracker, the 
other using a single-axis gimbal star tracker. The performance evaluation 
was conducted in the laboratory under simulated orbit conditions. These 
conditions consisted of the stellar optical stimuli and inertial attitude 
rates which would be experienced on a three-axis stabilized, earth-pointed 
satellite in geosynchronous orbit. 

The primary focus of the evaluation was on the contribution to the 
total system accuracy by the star trackers, and the effectiveness of the 
software algorithms in functioning with actual sensor signals. 

The performance criteria for the laboratory tests was the accuracy 
with which the PADS estimated its attitude throughout the test period 
relative to the inertial attitude of the laboratory at the start of the 
test. A ground-fixed laboratory test was performed in which the PADS axes 
remained stationary in the laboratory coordinates. Star stimuli were simu- 
lated by moving the star line of sight relative to the laboratory coordi- 
nates. A direct means of evaluating the PADS performance was obtained from: 
1) true knowledge of the laboratory inertial attitude as a function of time, 
and 2) precise measurement of the star line of sights relative to the 
laboratory, and hence inertial, coordinates. 

The performance goal for PADS was a steady state accuracy of 0.001 
degree (la) per axis. For the purposes of this program the one sigma two- 
axis or three-axis goal is defined as the RSS of the single axis goals. 

The laboratory environment was benign in terms of temperature and 
vibration. No bright object sources were simulated. Satellite attitude 
control rates were not simulated. Evaluation of these effects was con- 
sidered more properly relegated to the component test or design simulation 
level . 
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3. DESCRIPTION OF PADS 


Brief descriptions of the PADS hardware and software are given in this 
section. Detailed design information for the system components has been 
documented during previous efforts and programs and is referenced in the 
following descriptions. 

PADS provides estimates of the inertial attitude of its reference axes. 

A functional block diagram of PADS is shown in Figure 1-1. The star trackers 
provide periodic absolute attitude updates. The gyros provide continuous 
relative attitude data. The computer implements the software algorithms 
which combine these redundant sensor signals and estimate inertial attitude. 

The following paragraphs describe in detail the specific PADS components 
which were tested. Descriptions of the strapdown star tracker, the gimbal 
star tracker, and the gyros are given along with comments regarding their 
origin and level of development. In view of the offline data processing 
which was performed, a description of a flight suitable digital computer 
was not relevant. The software algorithms are described, but their adapt- 
ability to a flight computer is not discussed, again because it was not 
relevant to this test program. This latter topic has been covered, however, 
in previous studies described in the foreword. 

3. 1 HARDWARE 

The PADS hardware which was tested in the laboratory is illustrated in 
Figure 1-2. Two PADS configurations were tested, one using a strapdown star 
tracker, the other a gimbal star tracker. The same inertial reference unit 
was used for each configuration. This unit contained three gyros which had 
their input axes mounted orthogonal to each other. Since the emphasis of 
the test program was directed toward the performance capability of the star 
trackers and the effectiveness of the software algorithms, a flight-suitable 
computer was not used. Instead, the sensor data was collected on magnetic 
tape during the test using a CDC 1700 computer, and then processed post- 
test using a CDC 6500 computer. 
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3.1.1 Strapdown Star Tracker 

An extensive description of the strapdown star tracker (SST) is pre- 
sented in Volume I of this report. Detailed descriptions of the design are 
given along with extensive design analyses and test results. 

The star tracker is a high accuracy, high sensitivity sensor with the 
performance characteristics listed .in Table 3-1. The tracker has been 
designed to meet the PADS requirement to track 8 stars with 3 arc sec- 
onds accuracy. Engineering model level of development has been achieved. 

The star tracker uses an image dissector tube as its basic detector 
because the high sensitivity and resolution available from this instrument 
is consistent with the PADS requirements. The ITT F4012 image dissector 
was selected because of its proven reliability in space applications. 

Table 3-1. SST Design Parameters 


Field of View 

o 

or 

o 

Sensitivity 

10 Mv G0(60QO'^K) 

Photodetector 


Type 

ITT F4012 

Usable Photecathode Area 

12,7 pin 

Aperture OiamBter 

0.254 pm 

Optics 


Type 

Cassegrain 

Focal Length 

50,8 cm 

Aperture 

60 cm2 

Instantaneous Field of View 

103 arc sec 

Electronics 


Position Output 

12 bit serial Word 

Magnitude Output 

10 bit serial word 

Update Time 

0.1 sec 

Functional Perfomance 


Haxifflum Acquisition Time 

13.6 sec 

Maximun^ Track Rate 

0.02 °/sec 

Accuracy (with FOV and Temp. Cofnp.) 


Line of Sight to EO Axes 


Noise {lo)(sing1e satiple) 

3.0 arc sec [8 Mv) 

Fixed (Ir) 

£.0 arc sec 

EO Axes to Optical Reference 


Dias (3d) 

5. 1 arc sec 

Dias Stability (3t) 

1.3 arc sec 

Size 

12.7 X 12.7 X 56 cm 

Weight 

5 kg 

Power (using CMOS logic) 

4.6 watts 
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Photon counting is used as a detection technique because it provides 
superior sensitivity over that achievable with conventional analog tech- 
niques. 

The search, track, and mode control electronics are completely digital, 
not only to complement the photon counting technique, but to eliminate those 
errors associated with the conventional analog implementations. 

The entire electro-optical structure has been made from graphite/epoxy 
composite material in order to minimize all thermal distortions. This 
material has a linear coefficient of thermal expansion which is 100 times 
less than that of aluminum. 

A functional block diagram of the SST is shown in Figure 3-1. An 
explanation of the diagram is facilitated by considering four functional 
groupings : 

e Signal generation 

9 Acquisition 

e Track 

e Control. 

Signal Generation . Photons received from the star or target are 
focused by the optics to a spot on the photocathode of the image dissector. 
The resulting signal from the anode of the tube is processed by the video 
detector. For weak signals, the output of the video detector will be logic 
level pulses corresponding to the emission of electrons from the photo- 
cathode. For strong signals, in the presence of the cruciform spatial modu- 
lation pattern, the output will be a squarewave at the modulation frequency. 

Acquisition . Acquisition is achieved by scanning the 1° by 1° FOV 
with a discrete raster pattern produced by the acquisition scan generator. 
For normal acquisition the pattern is a 64 x 64 dot matrix which is com- 
pleted in less than 14 seconds. Proximity to a star is detected by the star 
presence circuit. This circuit counts the number of photoelectrons at each 
dwell point in the scan matrix. In the presence of a star, a dwell count 
significantly higher than the background noise count will be measured. By 
commanding the differential count necessary to indicate a star, stars equal 
to or greater than selected magnitudes may be acquired and tracked. 
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Track . Track is initiated by a signal from the star presence circuit. 
The track sweep generator starts eight continuous cruciform patterns at the 
position at which track was entered. If the star magnitude and track loss 
circuit does not indicate that a star is being tracked, then the acquisition 
scan is continued. The pulse synchronization circuit is the key element in 
enabling the tracker to track either bright or dim stars. In the case of dim 
stars, the circuit will produce pulses on a one-to-one basis with photo- 
electron pulses. By counting pulses in synchronization with the cruciform 
track sweep, the percentage duty cycle of the pulse width modulated (PWM) 
information is computed in the error detector circuit. On the other hand, 

bright stars will produce a squarewave at the video detector output which 
reflects the PWM information. By gating this signal with a high 

frequency clock, the information content is retained in the form of 
clock pulses instead of photoelectron pulses, and the percent duty 
cycle is again computed in the error detector circuit. By timesharing 
the error detector only one circuit is needed to compute the error 
for both axes. At the end of each crucifom pattern the computed 
error for each axis is summed with the number in the accumulator for 
that axis. Each accumulator drives a DAC which in turn drives the 
deflection amplifiers. Star magnitude is measured by the star 
magnitude and track loss circuit. 

Control ■ The tracker mode control is implemented by the mode control 
logic. The inputs to this circuit are: 

1 ) Star presence 

2) Track loss 

3) Search 

4) Zero. 

The last two signals are manual controls. A manual switch to disable the 
track loss signal is also provided. 

3.1.2 Gimbal Star Tracker 

The PADS requirement is for a single-axis gimbal star tracker. However, 
programmatic considerations necessitated the use of a two-axis star/landmark 
tracker developed under an Air Force contract. A detailed design description 
of this unit is given in reference. (1) To make the tracker compatible to 


the PADS requirements, the outer gimbal was mechanically locked and the 
landmark function was inhibited. The remaining star tracker functions 
represent the same technology developed previously by TRW for a single- 
axis gimbal star tracker. (2) The following description applies only to 
the modified tracker. 

The PADS gimbal star tracker (GST) consists of a Star Sensor Unit (SSU) 
mounted within a single degree of freedom Sensor Gimbal Unit (SGU). The SSU 
incorporates the optics, detector, and supporting electronics. The SGU is 
an exceptionally precise and stable mount providing gimbal drive for null 
tracking stars and precision angular readout of the gimbal. The GST inter- 
faces with the Sensor Electronics Assembly (SEA) which provides the gimbal 
angle processing and servo drive signals. The performance characteristics 
of the GST are shown in Table 3-2. 

3. 1.2.1 Star Sensor Unit 

The SSU is a high accuracy star sensor designed to track 3.5 stars 
with arc second accuracy. The SSU uses an image dissector tube together with 
conventional analog search and track electronics. 

The optical design results from a tradeoff between the desire for a 
short focal length to obtain small size and weight, and the requirement to 
maintain arc-second level accuracy. The selected design is a Cassegrain 
telescope utilizing aluminum optics. 

A bright object sensor and shutter assembly are incorporated in the 
sensor along with the high voltage power supply. The high voltage power 
supply will be incapacitated by the bright object sensor when the sun is 
within the 45 degree field, and also, a rotary solenoid will be actuated 
which will close the shutter in front of the photocathode. 

The sensor assembly has been designed with great care for thermal 
symmetry to provide maximum thermal -mechanical stability. In particular, 
the electronics are equally spread around the tube assembly. The high 
voltage power supply and line voltage converter, behind the tube assembly 
and the flange mounting, provide symmetrical heat transfer through the 
structure into the mounting plate. 
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Table 3-2. GST Design Parameters 


Field of View 

0.5 X 0.5 deg 

Gimbal Freedom 

Up to ±60 deg 

Sensitivity 

+3.5 my 

Bandwi dth 

25 Hz 

Optics 


Focal Length 

84 cm 

Aperture 

54 cm2 

IFOV 

84 arc sec 

Detector 

F4012 RP 

Minimum Sun Angle 

45 deg 

Accuracy (lo, per axis) 


Sensor 


Electronic Bias 

0.14 arc sec 

Thermo-Mechanical (Random) 

0.46 arc sec 

Noise Equivalent Angle 

1.2 arc sec 

Gimbal and Encoder 


Alignment 

0.71 arc sec 

Thermo-Mechanical Stability 

0.28 arc sec 

Inductosyn 

0.86 arc sec 

Readout Electronics 


Bias 

0.42 arc sec 

Random 

0.42 arc sec 

Noise and Quantization 

0.3 arc sec 

Size 

30 X 51 X 16 cm 

Weight 

13.6 kgm 

Power 

17 W 




I 


I 




The image dissector, deflection yoke, focus coil, and high voltage 
biasing network are all contained in a single, integral, encapsulated 
assembly. The outer structure of this assembly consists of the necessary 
magnetic shielding to prevent stray fields, or the earth's field, from 
affecting the image dissector, and is mechanically indexed directly to the 
optics. The electronics are contained on four flex-print interconnected 
printed circuit boards which are installed in the housing as a subassembly 
around the tube assembly. 

A functional block diagram of the SSU is shown in Figure 3-2. The 
following paragraphs explain the sensor operation. 

Video Processor . The video processor performs the following functions. 
During the search mode, automatic gain and threshold control circuits select 
only the largest video pulse present and send it to the mode control logic. 
When in the track mode of operation, the image dissector video is shaped 
into a digital pulsewidth-modulated signal and is fed to the demodulator. 

A digital star-presence signal and an analog star-magnitude signal are also 
developed , 



(ONLY ONE ERROFI CHANNEL IS SHOWN) 

Figure 3-2. Functional Block Diagram of Star Sensor Unit 
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Mode Control Logic . The mode control logic establishes the mode of 
operation: search or track. The timing of the search cycle, the gating of 

the tracking loop, and search-scan waveforms are also controlled by the mode 
logic. 

Demodulator . The demodulator circuits consist of timing gates to pro- 
cess the pulsewidth-modulated video and precision voltage switches which 
develop the tracking loop correction error voltage at the input to the 
tracking integrator. 

Tracking Integrators . This circuit consists of an integration stage 
(op-amp) which provides correcting dc voltages to the deflection generator 
to keep the star image centered in the image-dissector aperture by taking 
the integral of the error demodulator output. 

Scan Generator . The scan generator provides three separate circuit 
functions. A triangular waveform is generated by a counter-integrator com- 
bination and is used as the track mode scan waveform. Two binary counters 
and D/A converters are used to develop the stairstep-type search mode scan 
waveforms. The above scan waveforms and the dc-correcting voltage from the 
tracking integrator are summed in current dividers to provide the deflection 
coil current required. 

Error Amplifier . The dc component of the deflection coil current is 
determined by a current sampling resistor and the corresponding voltage is 
then amplified and filtered to give the required output pointing error 
gradient. 

3. 1.2. 2 Sensor Gimbal Unit 

The single degree of freedom gimbal assembly utilizes a proven single 
ball/flexure suspension system and Inductosyn readout. The gimbal is formed 
by Identical drive housing assemblies attached on each side of the star 
sensor unit. The drive housings incorporate the suspension/bearing system, 
drive motors, Inductosyn encoders, and data link. 

The use of identical drives on both ends of each axis is niotivated by 
the desire to obtain mechanical and thermal symmetry. The star sensor mass 
is centered between the supporting bearings of the gimbal. Nearly identical 
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power dissipation in each housing minimizes thernial gradient variations. 
Further, zero structural slope mounting points are chosen so that one-g 
distortions result in translation only - not in angular rotations. With 
this approach, testing can be accomplished with negligible errors due to 
gravity induced droop. 

Gi mbal Suspension 

The gimbal design features a one-ball bearing configuration. The 
geometry of this schone provides self-alignment features and facilitates 
the fabrication of the gimbal system by providing inherent reference for 
the establishment of the rotational axis of the gimbal. 

The desired axis is established by a line of contact of the balls with 
the cone surfaces of their retaining cups. The accuracy of the gimbal axis 
is set by the cups radii of contact and the ball sphericity. Since the ball 
sphericity can be obtained to two parts in a million and the cups radius of 
contact is established by lapping, and since all other critical surfaces are 
indexed to the payloads balls, the achievement of very accurate alignment 
is possible. The suspension consists of two single spherical balls sup- 
porting the payload. Each ball locates itself via two cone type cups. One 
cup (rotating retainer) is located on each side of the payload and the other 
cup (stationary retainer) is inclined 40 minutes of arc with respect to the 
center line passing through the centers of the spherical balls; the station- 
ary cup cone is eccentrically offset with respect to the centerline of 
the cylindrical shaft containing the cone. The shaft element is housed in 
the bore of the flexure, which is an intermediate element between the 
retainer and the gimbal frame. 

Drive Motors 

Each gimbal motor drive assembly is identical in performance and general 
configuration. It consists of a two phase permanent magnet motor and appro- 
priate support structure. The motor has 24 poles and 4 skewed slots between 
pole spaces. The commutation to the motor is provided by the Inductosyn 
resolver signal which is conditioned to provide the required power in terms 
of sine and cosine functions with periods satisfying the number of poles 
(12 speed). Interconnecting of the sine and cosine inputs to the respective 
motor winding results in a brushless motor exhibiting dc torquer character- 
istics. 
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Inductosvn Encoders 

The angular rotation of each gimbal is measured using a precision 
Inductosyn. The Inductosyn is a pair of discs, in this case 5 inches in 
diameter, which are mounted such as to rotate coaxially with respect to 
one another with facing surfaces in close proximity. The facing surfaces 
have printed conductors, forming winding circuits which may be flux linked, 
disc-to-disc. One disc, designated the rotor, has a single winding; the 
other, the stator, has two windings. The winding geometry is arranged so 
that the transformation coupling from rotor to stator varies trigonome- 
trically with relative disc rotation. The two stator windings are in 
mechanical quadrature to one another. Thus, the device is electrically 
identical to a synchro resolver, except for a very low coupling efficiency 
and for a larger number of poles than are normally found in a conventional 
resolver. 

Data Lin k 

The data link provides transmission of electrical signals across the 
gimbals without excessive restraint torques. The design utilizes an "S" 
folded conductor strip which is attached at the ends of and slides between 
a cylindrical stationary member attached to the housing sleeve and a smaller 
diameter cylindrical component (the rotating member) attached to the motor 
shaft. The inner and the outer members are lined with nylon rings to pro- 
vide electrical insulation and mechanical guide for the rolamite action of 
a 6 conductor strip. There are four such strips providing the capability 
of ±60° motion with restraints not exceeding 36 gm-cm. Both the 
stationary and the rotating members of this assembly are made from beryllium. 
Appropriate electrical connectors (miniature) are attached to the periphery 
of the rotating and stationary component. The data link itself is so 
designed that it can be removed from the system without disturbing the 
various electrical interconnections. 


3. 1.2. 3 Sensor Electronics Assembly 


The Sensor Electronics Assembly provides encoding of the Inductosyn 
gimbal angle signals and implements the controller /drive for the gimbal 
motors. Figure 3-3 shows the SEA functional block diagram for one of the 
two gimbal axes. The Inductosyn Electronics has as its function the 
excitation and processing of both multi-speed and single-speed Inductosyn 
output signals to derive the precision measure of gimbal angle. The Drive 
Electronics provides for loop compensation and appropriate commutation, and 
and motor p. 'er drive functions. 

Inductosyn Electronics 

An Inductosyn is analogous to a resolver. It has a primary, the rotor, 
which is sinusoidally excited at some frequency, 10.3 kHz in this case. It 
has two secondary (stator) output signals of the same frequency, whose 
amplitudes are trigonometrically amplitude-related to the device's mechani- 
cal angle: 


= kV^ sin ne sin tu„t 

s e e 

V., = kV„ cos ne sin w t 

c e e 

where e is the mechanical angle, is the rotor excitation amplitude, and 
ujg is its frequency. The transformation ratio, k, is extremely small for 
an Inductosyn, such that the output signal is only a few millivolts. Each 
Inductosyn has a single-speed and a 256 speed set of windings. The speed 
ratio, n, is unity for the single-speed section and 256 for the multi-speed 
section. Thus, the single-speed outputs advance one electrical revolution 
for each mechanical revolution, vi^hile the multi-speed signals advance 256 
electrical revolutions for the same mechanical rotation. By processing 
both pairs of signals an extremely high resolution can be achieved. 
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Figure 3“3, Sensor Electronics Assembly Functional Block Diagram 




The Inductosyn signals are amplified by special preamplifiers located 
on the gimbal, and the resultant signals transmitted to the SEA for further 
processing. Within the SEA, the signals are converted from amplitude to i.. 

phase format. Each pair, as decribed above is converted to a phase pair: 

i \ ' 

= V sin ((Ogt + ne) 

Vg = V sin (iDgt - ne) i' ; ' 

■ i 

Thus, gimbal angle information now resides in the relative phase of the 'j | 

signals, in "double-angle" form, i.e., the relative phase between and j 

Vg changes twice as fast as ne. These signals are then converted to : ■ | 

standard logic signals, A and B, for use by the encoder logic. The | 

amplitude-to-phase converters are specially designed to preserve the 

inherent Inductosyn accuracy. A computer analysis has shown a worst-case | 

error of ±0.03 degree electrical for the converter itself, excluding pre- | 

amplifier gain variations and zero-crossing detector propagation delay | 

variations. | 

The Encoder section is used to digitally measure the relative phases ' I 

of the A and B signals from the amplitude-to-phase converters, and thus, | 

to develop a digital quantity representing the gimbal angles. | 

j 

Gimbal Control Electronics ^ 

The control electronics has two modes which are commanded by an 
external computer: 

i 

1) Slew j 

2) Track. j 

In tne slew mode a servo summing junction is implemented in the 
computer using the desired position profile and the SEA inductosyn readout. 

The error signal from this junction is used to drive the gimbal servo elec- 
tronics. A rate signal can also be commanded by the computer to augment 
the gimbal response performance. Operationally , this mode is used to j 

position the gimbal so that a star will be in the field of view of the ; ! 

SSU. f 
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If the SSU acquires a star* 1t will send a track signal to the com- 
puter. The computer in turn will command the gimbal control electronics 
into the track mode. Here the vertical deflection signal from the SSU 
is used as the error signal to the gimbal servo electronics. The elec- 
tronics will drive the gimbal motor until the SSU signal is nulled, i.e., 
the star is positioned midway between the top and bottom of the field of 
view. 

The servo design consists of a proportional plus integral mechanization 
which eliminates gimbal hangoff due to static bearing friction. In both 
modes the servo is damped by a rate signal derived from the inductosyn 
information. The rate loop is also implemented with a proportional plus 
integral design to compensate for running bearing friction. 

3.1.3 Inertial Reference Assembly 

The original plan for the PADS program was to receive a gyro assembly 
for the laboratory tests from NASA/Goddard Space Flight Center (GSFC). This 
assembly would have used the Bendix 64 PM RIG gyro in a configuration 
similar to that for the International Ultraviolet Explorer Satellite. 
However, procurement difficulties experienced by GSFC prevented use of this 
gyro assembly on the PADS program. In its place GSFC subtituted an engi- 
neering model version of the Orbiting Astronomical Observatory Inertial 
Reference Unit (OAO/IRU). A detailed design description of this unit is 
given in reference (3). The following description is extracted from this 
reference and is limited to only those aspects relevent to the PADS testing, 

3.1.3. 1 General Description 

The IRU used in the laboratory tests consists of two packages: an 
Inertial Package (IP) and an Electronics Package (EP). A test console was 
also supplied by GSFC which provided an electronic interface capability with 
the IRU. 
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The test console provided all the necessary commands and power to 
operate the IRU. Aside from the start-up and shut-down procedures, the 
only interfaces with the test console during the PADS tests were manual 
changes to the R-Term compensation for all three gyros. These changes 
simplified the quick look display of the gyro performance during the 
testing. 

A data interface unit was added to the test console by GSFC to transmit 
the gyro outputs to the PADS data collection system. Each output consists 
of a 16 bit word representing the inertial rotation about the gyro input 
axis. The scaling is nominally 0.075 arc sec/count. The 16 bit word turns 
over after approximately 1.4 degrees. 

It 

The IP is a temperature controlled cube 9 inches on a side. It weighs 
18 kg and contains three precision gyros, their control and readout 
electronics, a frequency source assembly which provides the precision fre- 
quency for all the electronics in the IRU and temperature control electro- 
nics. Attached to the IP are radiator plates which conduct heat away from 
the IP. Each radiator is approximately 7.6 x 22.9 cm in area. 

The gyros mounted in the IP were fabricated at MIT. They are MIT 
designed adaptations of the inertial grade 2FBG-6F floated gyro. The 
2FBG-6F gyro was modified for the OAO mainly by simplifying its construc- 
tion and by improving its data bandwidth capability. The gyros are operated 
with binary pulse restrained torque loops. Torque data from the gyros are 
processed as rate integrals (i.e., angles) in the EP and converted to digital 
signals. The IRU's reference position about each axis can either be reset 
or changed incrementally. The resets are enabled by programmed commands. 
Incremental changes in position are limited to one axis at a time. 

For the PADS tests the IRU was operated only in the HOLD mode. During 
this mode, the rate capability is 15 arc sec/sec, or earth rate. The indi- 
cated rate of each gyro output can be digitally compensated in the EP 
(referred to as R-Term compensation). 


3-16 


The gyro electronics, temperature control, and frequency source 
electronics consist of potted cordwood modules and discrete components, 
assembled into the following subassemblies: Frequency Source Assembly, 

Temperature Control Assembly, Auxiliary Temperature Control Assembly, 

Torque Generator End Assembly (TGEA) and Signal Generator End Assembly 
(SGEA). Each gyro has a TGEA and S6EA mounted with it, and tuned to it, 
to provide proper gyro parameters. A total of 21 cordwood modules is used 
in each IP. 

IE 

The EP is a rectangular assembly, 22.9 x 38.1 x 15.2 cm weighing 17.3 kgm, 
made up of 3 electronic trays and an annex attached to tray 1. Contained 
in the 3 trays and annex are 63 potted cordwood modules and a number of 
discrete components, power transistors, transformers etc. 

The EP contains analog, digital and hybrid electronics. There are 17 
major electronics blocks including: power supplies, control units, input/ 

out units, logic and conditioning units. 

3. 1.3. 2 IRU Performance 

The IRU was tested at 6SFC by personnel from Charles Stark Draper 
Laboratory prior to delivery to TRW for the PADS tests. This testing is 
described in Appendix C of this report. In summary, the tests showed that 
the performance of all three gyros was degraded. The z(yaw) gyro was 
especially bad. 

Following setup and integration at TRW, the IRU performance was again 
observed and found to be different from that measured at GSFC. This encour- 
aged efforts to improve the IRU. Two actions undertaken did improve the 
performance: 

1) A rewiring of the power interface 

2) A change in the thermal configuration. 

The performance was again measured by CSDL and found to be significantly 
improved. These results are also described in Appendix C. 
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The gyro performance is described in Appendix C in terms of power 
spectral density (PSD) curves. Another method which was used to character- 
ize the random drift of the gyros is to plot the standard deviation of the 
gyro attitude as a function of sample time. Figure 3-4 illustrates the 
approach which was taken. The standard deviation was calculated as: 



where 

N = the total number of samples 

30 = the attitude change over a sample time At. 

Figures 3-5 through 3-7 show the standard deviation plotted as a function of 
sample time for the three gyros. The data was derived from two runs taken 
on 5 September 1975 and 19 September 1975. The first run duration was three 
hours and gyro attitude was recorded every one second. The second run 
duration was 60 hours and the data was recorded every 100 seconds. When 
available, 50 samples were used to compute the standard deviation. 


0 



Figure 3-4. Characterization of Gyro Random Drift 
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Figure 3-7. Z Gyro Random Drift 

The figures indicate that the standard deviations after 20 minutes 
for the X and y gyros are 0.8 and 1.0 arc seconds, respectively. By 
coincidence, these values are remarkably close to the value measured for 
the originally considered Bendix gyros, namely, 0.4 arc seconds. Also 
by coincidence, both the x and y gyros and the Bendix gyros have a slope 
of plus one (log-log plot) for 20 minute and longer samples. These 
similarities between the malfunctioning IRU x and y gyros and the Bendix 
gyro confirmed the decision to run the PADS tests with the IRU. 

The standard deviation for the z gyro is 4 arc seconds at the 20 
minute sample time, and its slope is erratic. While this performance is 
not ideal, it is close enough to the desired level for the gyro to be used 
in the system tests. In the evaluations of the system tests results in 
Sections 9 and 10, the effect of the poor performance of the z gyro on 
system accuracy is pointed out, 

A final comment is appropriate regarding the performance of the x and 
y gyros. The time plots of gyro drift rate in Appendix C clearly indicate 
that the dominant error characteristic is a squarewave variation with a 



period of approximately 17 hours. It is this characteristic which produces 
the slope of plus one in Figures 3-5 and 3-6. Although unknown in origin, 
this error is definitely deterministic in appearance. 

3.2 SOFTWARE 

The software design is, in general, characterized by achieving desired 
system performance with the minimum of equation complexity. Throughout the 
equation development, for example, models derived to compensate for sys- 
tematic errors in the on-board system are simplified to the level consistent 
with desired performance. In most cases, for example, this resulted in only 
first-order terms being retained. 

The software is designed to perform executive functions (program con- 
trol, self-test, system test, etc.), attitude determination, and pointing 
control in the case of the ginfcal star tracker. The attitude determination 
software derives inertial attitude by integration of the gyro outputs, and 
employs a Kalman filter for periodic updates to bound the errors. Develop- 
ment of the attitude determination equations required a variety of tradeoffs 
to determine the appropriate algorithms and design approach. On the other 
hand, development of equations for transformations, star selection, and 
gimbal pointing is straightforward, although algebraically complex. 

Choice was available for selection of the kinematic variables used to 
propagate rate through the required numerical integration. Euler symmetric 
parameters were selected, as opposed to direction cosines, based upon the 
use of a four, rather than nine, parameter system of equations; also, the 
periodic renormalization that must be performed to combat computer roundoff 
error is much simpler. A closed form solution is utilized, under the 
constraint that the vehicle rate can be assumed constant over each inte- 
gration interval. The closed form solution tends to inhibit the truncation 
error that would normally exist in the power series representation. Design 
analysis was also conducted to establish the integration step size and the 
effect of computer (roundoff and truncation) errors. 

The Kalman filter state vector was limited to six elements (three 
attitude variables and three gyro biases) to minimize the problem dimen- 
sionality while achieving desired performance. Additional states (such 
as alignment/scale factor parameters in gyros and trackers) were found 
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not to be justified based upon inherent accuracy/stability and/or relative 
sensitivity. The extended Kalman filter formulation is utilized where 
linearization takes place about the previous attitude estimate. 

The Kalman filter requires a priori definition of the initial state 
error covariance matrix, the measurement noise covariance matrix, and the 
state noise covariance matrix. The initial error covariance matrix reflects 
the initial uncertainty of the state estimates, and the elements are selec- 
ted a priori based upon the expected initial attitude uncertainty. There 
appeared to be little influence of the initial estimate for error covari- 
ance, but good design practice indicated selection of values larger than 
the actual expected initial attitude errors. 

State noise arises principally from the gyro random drift, and the 
elements of the state noise covariance matrix are derived a priori based 
upon the estimated (measured) gyro noise statistics. The influence of 
state noise on performance was determined by evaluating the relative error 
as a function of state noise parameters. A value of the elements of the 
state noise covariance matrix can be determined which corresponds analyt- 
ically to the value of gyro noise assuming a white noise gyro model. The 
tradeoffs indicate that a good design procedure is to utilize the analyt- 
ically derived values for the state noise covariance matrix which corre- 
spond to a conservative estimate of gyro noise. 

The elements of the measurement noise covariance matrix are based upon 
a priori estimates (measurements) of tracker noise. Tradeoffs were made for 
selection of elements of the measurement noise covariance matrix utilizing 
a parameter variation study employing various values of tracker noise and 
measurement noise covariance values. This tradeoff led to the indication 
that performance can be best achieved through selection of elements of the 
measurement noise covariance matrix which are, in fact, optimistic. 

The PADS software is configured in a modular structure which will 
permit operational flexibility, capability for growth, and ease of modifi- 
cation. The software makes use of state-of-the-art techniques so far as 
possible, consistent with the capability of present generation spaceborne 
computer technology. The software is segmented into modules to be executed 
under control of the PADS executive according to a preassigned interactive 
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cycle. Individual program module interfaces have been allocated based upon 
cycle requirements of the main computation loops. 

The following two sections explain those aspects of the PADS software 
which are peculiar to the strapdown and gimbal systems and their respective 
star trackers. 

3.2.1 Strapdown System Test Associated Software 

The sensor information provided by the Inertial Reference Unit (IRU) 
and the Strapdown Star Tracker (SST) are inputs to the strapdown algo- 
rithm, whose purpose is to establish system (spacecraft) attitude and 
estimate the IRU drift rates. A top level program flow diagram is illus- 
trated in Figure 3-8. Its first task is to rend Tape 1 which contains 
quantitative parameter values associated with the IRU and SST as well as 
initial estimates (and their statistics) associated with both attitude 
and gyro drift rates. Table 5-1 in Section 9 specifies a typical list of 
such inputs. Next a block of IRU and SST data is read into the computer 
via Tape 4, with successive blocks read thereafter as the data is utilized. 
For the PADS laboratory setup, the air bearing table angle is also input 
via Tape 4, as it establishes the reference star line-of-sight to be 
utilized by the SST. Next the attitude and drift state transition matrices 
are initialized, and a time tagged slice of sensor data read from the com- 
puter memory. If it is not time to terminate the run, the algorithm forms 
angular rate estimates, applying appropriate drift rate compensations. 

Next the actual attitude is estimated based upon the previous estimate and 
the intervening angular rates. The system state can then be printed on the 
output tape (Tape 2), if desired, and unless there is SST data associated 
with the present time slice, control returns to a for reading the next time 
tagged data entry. 

When SST data does appear, a countdown begins until that data is 
actually utilized since the azimuth output of the SST becomes more accurate 
towards the center of its field of view. Once the data is utilized, the 
appropriate star is first identified, through use of the air bearing table 
angle, and the SST output corrected to compensat‘d for nonlinearities off 
its boresight. The a priori estimate of expected SST output based upon the 
estimated rather than actual attitude is next formed, and subtracted from 
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Figure 3-8* PADS Strapdown Software Flow Diagrain 
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the actual readings to establish azimuth and elevation measurement 
residuals. The Kalman Filter algorithm is then applied resulting in both 
attitude and RGA drift rate updates. Also derived is an update of the 
state ev’ror covariance matrix, which establishes to what extent the algorithim 
believes its estimates. Control then returns to $ for a new filter cycle. 

A detai"^ed listing of this computer program appears in Appendix A. 

3.2,2 Gimbal System Test Associated Software 

The computer program associated with the GST version of PADS is almost 
identical to that associated with the SST version. The only significant 
difference involves the replacement of the SST subroutine forming estimated 
star tracker readings in Figure 3-8 by an equivalent GST subroutine. A 
detailed listing of the GST version is presented in Appendix B. 


4. TEST CONFIGURATION AND ACCURACY 


This section describes the laboratory test configuration in relation- 
ship to the simulated geosynchronous orbit environment. In addition the 
potential laboratory error sources are detailed. 

4.1 SIMULATED ORBIT CONFIGURATION 

The objective of the PADS system tests was to determine the perfor- 
mance capability of a PADS system in geosynchronous orbit through laboratory 
simulation. Two PADS systems were tested, one using a strapdown star 
tracker, the other using a single-axis gimbal star tracker. The simulated 
orbit conditions were the stellar optical stimuli and inertial angular rates 
which would be experienced on a three-axis stabilized, earth-pointed satel- 
lite in geosynchronous orbit. 

Before hypothesizing the orbit configuration of both PADS systems, a 
number of practical test limitations had to be considered. The most impor- 
tant limitation was that only one strapdown star tracker could be developed 
under the scope of the program. Since practically no geometric leverage is 
obtained about the boresight of a 1° by 1° field of view, this meant that 
system performance would be achieved only about the two axes normal to the 
boresight: in essence, a two-axis test for the strapdown system. 

Another limitation was the fact that it was technically impossible 
within the scope of the program to accurately simulate bright object inter- 
ference to the performance of the star trackers. In view of this, the 
assumed orientations of the tracker fields of view in orbit were picked 
with the objective to make sensor errors as nearly as possible one-to-one 
with system errors. 

With these considerations in mind the simulated orbit configurations 
which were arrived at are shown in Figure 4-1. It is seen that the strap- 
down system is a two-axis system consisting of one narrow field of view and 
two gyro input axes orth /gonal to the field and to each other. For maximum 
star availability on the assumed uniformly distributed celestial sphere, the 
field of view points at the celestial equator. On the other hand, the gimbal 
system is a three-axis system since the 90 degree sweep of the tracker field 
of view does give adequate geometric leverage for three-axis tracker infor- 
mation, supplemented by the three orthogonal gyro axes. The center of the 
sweep is also pointed to the celestial equator for maximum star availability. 
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Figure 4-1. Simulated Orbit Configuration 

The driving function for star update frequency is the random drift of 
the gyros. For the class of gyro considered on PADS a nominal update 
period of 20 minutes has been chosen in order to result in a total system 
accuracy of 0.001 degree. Using the equations developed in Volume I, 

Section 2.2, a 20 minute period in the case of the strapdown star tracker 
gives a probability of at least one star occurring in the field of view of: 

p = 0.9963 

For the gimbal star tracker a 20 minute period gives a probability of 

p = 0.9736 

To make the probability for the gimbal tracker equal to that of the strap- 
down tracker the update period must be extended to 32 minutes. 

For the PADS testing the decision was made to make the star update 
period 20 minutes for both strapdown and gimbal cases. This is equivalent 
to acquiring a star every 5 degrees of right ascension in geosynchronous 
orbit. In the analysis of the test data a parametric analysis of the effect 
of update period was obtained by skipping updates. In this manner 20, 40, 
and 60 minute update periods were obtained. This approach was taken since 







it simplified test procedures and avoided longer test runs in the case of 
the gimbal system. Comparison between the two systems was made on the 
basis of the parametric analyses. 

Three different star declinations were used in the case of either 
system. For the strapdown system the purpose of multiple declinations was 
to exercise the accuracy of the tracker at more than one place in the 
field of view. The three declinations were; 

e Star 1: 911.6 arc sec (0.3°) 

0 Star 2; 0.0 arc sec {0.0°) 

0 Star 3: -326.0 arc sec (-0,1°) 

For the gimbal system the motivation for three declinations was to obtain 
three-axis star tracker information as well as to exercise the accuracy 
of the gimbal readout. Here the three declinations were; 

0 Star 1: 53814.9 arc sec (14.9°) 

0 Star 2 : -14564.8 arc sec (-4.0°) 

0 Star 3; -82958.0 arc sec (-23,0°) 

4.2 LABORATORY TEST CONFIGURATION 

The key distinguishing feature of the laboratory test configurations 
for both the strapdown and gimbal system tests is that a ground-fixed 
test is implemented. The earth itself is used to simulate the inertial 
motion of an earth-pointed geosynchronous satellite. This is accomplished 
by mounting the PADS sensors stationary to the laboratory floor, which 
itself is a seismic pad isolated from building vibrations. The stellar 
optical stimuli are simulated by sweeping collimating star beams past the 
stationary PADS sensors. Ideally, the star beams, which are revolving 
at earth rate relative to the laboratory, are stationary in inertial 
coordinates since their rotation relative to the laboratory cancels the 
rotation of the laboratory, or the earth, relative to inertial space. In 
practice, since it was more practical to have the rotation axis of the 
stars vertical in the laboratory, and since the laboratory location was in 
Manhattan Beach, California, the star line-of-sights actually were rotating 
in inertial space. However, since the stars were revolved at earth rate 
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relative to the star trackers, the test configuration still satisfied the 
objective of the tests, namely, to evaluate the performance of the PADS 
systems. 

Isometric representations of the strapdown and gimbal configurations 
are shown in Figures 4-2 and 4-3, respectively. Table 5-1 in Section 5 
identifies the numbered equipment. Photographs of the actual configurations 
are shown in Figures 4-4 through 4-17. Figures 4-4 through 4-10 show details 
of the star stimulus of the strapdown star tracker. Stimulus of the gimbal 
star tracker is shown in Figures 4-11 through 4-16. The inertial reference 
assembly is shown in Figure 4-17. 

The ground- fixed test provided two major advantages over the conven- 
tional approach of rotating the PADS on a rate table in the center of a 
room, and placing multiple star sources around the room which point at the 
rotating PADS. The first advantage is that the ground-fixed approach is 
compatible with the parallel beam star stimulus technique described in 
the following section. This technique is essential to providing laboratory 
instrumentation knowledge of star locations with one arc second accuracy. 

The technique is not compatible with the rate table and multiple stars 
approach. The second advantage is that the artificial subtraction of 
earth rate from the gyro outputs is not necessary in the ground- fixed 
approach. In fact, it becomes technically dubious in the rate table approach 
since a vector of the same magnitude as that produced by the rate table must 
be subtracted from the gyro outputs. 

In the ground- fixed test approach, the PADS axes are identical to the 
laboratory axes. Both are physically defined by optical surfaces on the 
star trackers. The strapdown star tracker uses the normals to two faces of 
an optical cube to define the axes. The gimbal star tracker uses an ortho- 
gonal set of axes whose orientation is defined relative to three mirror 
surfaces on the tracker base. Star orientation relative to the laboratory 
(and PADS) axes is measured by laboratory instrumentation . 

The PADS output is a continuous estimate throughout the length of the 
test run of the attitude of the PADS axes relative to their inertial atti- 
tude at the start of the test run. For performance evaluation this output 
is compared to the continuous inertial attitude of the physically defined 
















Figure 4-4. View of Strapdown Configuration 


View of Strapdown Configuration From Back of 
Theodol i te 
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View of Automatic Autocoll imator From Right 
of Star Source 


View of Automatic Autocollimator From Left 
of Star Source 
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Figure 4-13. Side View of Theodolite and Double-Sided 
Mi rro»" 


Figure 4-12. View of Gimbal Configuration From Back of 
Theodolite 


4-11 





r': 

-yN 



k- ■ 



"1 

iM 






I: v-^ 







Figure 4-16. Stationary and Rotating Mirrors in Reference 
Position 
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PADS axes. This attitude is derived from the inertial attitude of the 
laboratory axes at the start of the test and from knowledge of the rate 
of the earth's rotation. The star orientation is measured relative to 
the laboratory axes. It is important that the star orientation in labor- 
atory axes be known very accurately using laboratory instrumentation. 

An error in knowledge of the star position will result directly in an 
error in the performance evaluation of the PADS. 

4.3 PARALLEL BEAM STAR STIMULUS TECHNIQUE 

The key test configuration accuracy requirement is to know the orien- 
tation of the star line-of-sight relative to the laboratory axes, which 
in this case are also the PADS axes. Since the PADS performance require- 
ment is 3.6 arc seconds per axes, knowledge of the star orientation must 
be significantly better than this value. By using a parallel beam star 
stimulus technique an accuracy approaching one arc second was obtained. 

The parallel beam technique is perhaps best illustrated by the top 
view of the strapdown system test configuration shown in Figure 4-18. 
Functionally, the performance of a star transit (defined as a sweep of a 
star through the field of view of the tracker) is straightforv/ard. The 
collimated star beam from the star source is reflected off the rotating 
mirror mounted on top of the air bearing table. The table is turned at 
half earth rate so that the reflected star beam sweeps past the star 
tracker at earth rate. In order to measure where the star beam is relative 
to the PADS axes, i.e., the optical cube on theVight side of the star 
tracker, the collimated beam from an automatic autocollimator is trans- 
mitted parallel to the star beam. The normal to the front face of the 
cube is the defined boresight axis of the tracker. When the star beam 
(Star 2) is concident with the boresight axis, the autocollimator beam 
will be normal to the front face, and the horizontal and vertical output 
of the two- axis autocollimator will be zero. 

This use of the automatic autocollimator is suitable for a static 
indication of the star orientation in a small region around the boresight 
axis. However, its limited range (±50 arc sec) and dynamic response (0.13 
arc sec per arc sec/sec) make it unsuitable for a star sweeping through 







the 1° field of view at earth rate during a star transit. For this case 
the air bearing table readout is used. The zero reference for the read- 
out is obtained by making a static table reading at the boresight position 
indicated by the automatic autocollimator. 

So far the discourse has been limited to measuring the location of 
the center star (Star 2) relative to the PADS axes. By independently 
measuring the relative locations of the other two stars to the center 
star, their locations relative to the PADS axes can also be determined by 
the parallel beam technique. The independent measurements were made with 
a theodolite. The gravity vector was used as a reference for rotations 
about the boresight axis. 

The key to the successful implementation of the parallel beam method 
is the ability to recalibrate as frequently as necessary the parallelism 
between the collimated center star and autocollimator beams. This is 
facilitated by use of the theodolite and double-sided mirror shown in 
Figure 4-18. The double-sided mirror is positioned halfway in front of 
the aperture of the theodolite. The backside mirror is positioned per- 
pendicular to the theodolite boresight by using the autocollimator feature 
of the theodolite. Since the frontside mirror is parallel to the backside 
mirror, the normal to the frontside is then parallel to the telescope 
boresight of the theodolite. Both can now be used to calibrate the paral- 
lelism between the two collimated beams. The air bearing table is rotated 
until the star beam is along the boresight of the theodolite. When this 
condition exists, the automatic autocollimator will adjust its beam normal 
to the frontside mirror. Any, deviations from zero of the autocollimator 
horizontal and vertical outputs represent its null bias errors. The utility 
of this recalibration method is that it can be performed at any time during 
a test period. 

The operational procedure which was developed during the test phase 
was to recalibrate in two stages. The strapdown or gimbal test consisted 
of four runs, four hours or longer in duration, which were performed over 
a ten day period. Since the star source beam would drift relative to the 
theodolite up to a couple of arc seconds per day, and since the air bearing 
table readout zero position would also shift from turn-on to turn-on, the 
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two collimated beams were realigned parallel at the start of each run. This 
was accomplished by driving the table to the reference (theodolite) position 
adjusting the theodolite so that the center star was on boresight, adjusting 
the double-sided mirror face normal to the boresight, and then adjusting 
the autocollimator mirror to give zero horizontal and vertical output 
for the automatic autocollimator. The alignment of the star and double- 
sided mirror to the bores ight was also checked at the end of each run to 
verify that no detectable misalignment occured. This was found to always 
be the case. During the four or five hour test run, however, the automatic 
autocollimator would drift up to three arc seconds. Therefore, before the 
start of each star transit (20 minutes apart), the table would be driven to 
the reference position and the autocollimator zero position recalibrated. 

By using this operational procedure the only temporal stability require 
ments necessary for the entire test configuration were: 

1) A four or five hour stability of the star source relative 
to the theodolite 

2) Approximately a five minute stability of the autocoll imator 
beam relative to the star beam. Stabilities better than 
one arc second were easily obtained by using a thermally 
passive star source and the Davidson Model 696 autocollimator. 

4.4 LABORATORY ERROR SOURCES 

The PADS system axes are defined by the optical cube. The computer 
axes are an analytical entity and represent the computed estimate of the 
orientation of the system axes relative to a set of reference axes. The 
computed estimate is derived from gyro and star tracker information. The 
reference axes are defined to be the inertial attitude of the system axes 
at the start of the test period. 

The test purpose was to compare the attitude of the computer axes with 
that of the system axes, where both are expressed relative to the reference 
axes. The system attitude error is indicated by 

hi ' hi 

where Aj^^ ^XZ direction cosine matrices of the computer and 

system axes, respectively, relative to the reference axes. 
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The matrix computed from the initial estimate of its orientation 

relative to the reference axes (which are also the system axes at test 
start), and from the output signals of the gyros and the star trackers. 

The matrix computed from knowledge of the initial orientation of 

the system axes at test start relative to the earth rate vector, and from 
time. 


Figure 4-19 provides a useful representation of the coordinate axes 
and star vectors involved. Misalignment between computer and system axes 
is indicated at a star update time as the difference between: 

1) Where the star should be in computer axes 

2) Where the star is actually measured in system axes by the 
star sensor. 


Where the star should be in computer axes is calculated as a function of; 

1) The direct'''on cosine matrix (or quaternion) relating the 
computer axes to the reference axes 

2) A star catalog which describes where the star is in the 
reference axes. 

This difference is then used (via a Kalman filter) to correct the direction 
cosine matrix. In between star update times, the incremental attitude change 
measured by the gyros is used to change the direction cosine matrix. 

In the PADS laboratory test configuration the star catalog information 
is partly measured and partly analytical. The autocollimator directly mea- 
sures where the star is in system axes, but the orientation of the system 
axes to the reference axes is an analytical relationship established by 
definition and the laboratory measurement of time. 

Thus, laboratory measurement accuracies can be divided into two links: 

1) The attitude of the system axes relative to reference axes 

2) Star position relative to system axes. 

The following sections describe the errors associated with both. 
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Figure 4-19. PADS Coordinate Systems 


4.4.1 PADS System Attitude Uncertainties 

Consider first an error in the matrix Aj^^ start of the test due, 

for example, to incorrect knowledge of the latitude of the laboratory. This 
error will not evidence at a star update since % TS used in both those 
quantities which are differenced and input to the Kalman filter. The error 
will cancel itself. On the other hand, it will appear initially in the 
gyro outputs. But, after a number of star updates, the filter will attri- 
bute the error to a gyro bias and thereafter compensate for it. Since the 
PADS system experiences a constant rate vector (earth rate) throughout the 
test, this error is indistinguishable from actual gyro bias error, scale 
factor errors, or input axis misalignments. However, separately identifying 
these error sources was not considered essential to the test objective of 
determining the PADS performance capability. 


Seismic disturbances of the laboratory during a four or five hour test 
run will directly affect the laboratory evaluation of PADS. These distur- 
bances will evidence as a random drift component in the gyro outputs. 
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However, from the measurements of the OAO/IRU performance both at GSFC and 
TRW it is clear that the gyro errors will completely predominate over 
possible seismic motions of the isolated laboratory floor. 

Summarizing, neither static nor dynamic errors in describing the 
orientation of the PADS axes relative to inertial space significantly affect 
the laboratory evaluation of the PADS accuracy. 

4.4.2 Star Position Measurement Errors 

Determination of star position relative to the PADS system axes 
represents the major laboratory measurement error affecting the laboratory 
evaluation of the PADS accuracy. Since the PADS accuracy goal is 3.6 arc 
sec (la), the goal for this error source arbitrarily was selected to be 
0.36 arc seconds (lo), or 1.1 arc seconds (3a). The ground rule was estab- 
lished that no attempt would be made to improve the measured PADS accuracy 
results by subtracting out either a statistical or deterministic measure of 
the laboratory errors. 

Accuracy in knowledge of star line-of-sight position relative to the 
PADS axes is limited by three types of errors: 

1) Absolute Errors . This term refers to systematic error 
sources which are present for all test runs. 

2) Repeatabi 1 i ty Errors . These are errors due to the 
realignment of the parallel beams prior to each test run. 

These errors are random from run to run, but constant for 
any one run. 

3) Random Errors . These errors are random for any sequence 
of star measurements made either during a star transit or 
from transit to transit. 

A further distinction which has been made is whether or not an error affects 
all three stars in the same manner, or if it is uncorrelated from one star 
to the next. 

The error sources for the PADS test configurations are shown in 
Table 4-1. Since the purpose of the test program was to determine the 
performance capability of PADS, the systematic error of 3.3 arc seconds 
for all three stars, during all test runs, was not considered relevant. 

This error will not show up in the test results since both star trackers 
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Table 4-1 . Star Measurement Errors 


Error Source 

Strapdown System 
Error — Arc Sec 

Gimbal System 
Error *- Arc Sec 

All Stars 
(3o) 

Star to Star 
(3a) 

All Stars 
(3o) 

Star to Star 
(3c) 

1. Absolute Errors - All Runs 





Star Position Measurement 

0,0 

0.6 

0,0 

1.2 

Star Beam Collimation 

0.0 

0,0 

0.0 

0.0 

Star Intensity Uniformity 

3.0 

3.0 

3,0 

0.0 

Double-Sided Mirror Nonparallelism 

1,0 

0,0 

1.0 

0.0 

Theodolite Bores ight Alignments 

0.7 

0,0 

0.7 

0.0 

Theodolite Spherical Aberrations 

0.0 

0.0 

0.0 

0,0 

Theodolite Circle Accuracy 

0.0 

0.6 

0.0 

0.6 

Theodolite Level Accuracy 

0.0 

0.0 

- 

- 

Table Readout Accuracy 

0.3 

0.0 

- 

-- 

RSS 

3.3^ 

3.1^ 

3.3^ 

1 .3 

2. Repeatability - Run-to-Run 





Theodolite FOV Precision 

0,6 

0.0 

0.6 

0,0 

3. Random — During Run 





Autocollimator Noise 

- 

0.2 

- 

0.2 

Autocollimator Drift 

-- 

0.0 

-- 

0.0 

Autocollimator Scale Factor Error 

- 

0.3 


0.3 

Table Readout Quantization 

- 

0.6 

- 

0.5 

RSS 


0,7 


0.6 


1. Not relevant to PADS test. 

2. Eliminated by field of view calibration and compensation. 



are Initially aligned using the same test configuration. It would surface, 
however, if the same PADS hardware, aligned using the laboratory configura- 
tion, were operated in orbit. The star to star absolute error of 3.1 arc 
seconds for the strapdown system also was eliminatf by performing a strap- 
down star tracker field of view calibration and compensation using the same 
test configuration. As described in Volume I, Section 7, this was necessi- 
tated by inconsistencies discovered in the initial calibration data for the 
strapdown star tracker. All the remainder of the errors do affect the PADS 
performance results, and in combination (RSS) give 0.9 arc seconds (3a) for 
the strapdown system and 1.6 arc seconds (3a) for the gimbal system. 

The most significant fact regarding the errors listed in Table 4-1 is 
that no significant error source due to temporal instabilities or drifts is 
present. As previously mentioned, this is a result of use of the parallel 
beam technique. 

The following sections describe in detail the error sources listed in 
Table 4-1. 

4.4.2. 1 Star Source 

The primary requirement for the star source was that it be stable to 
within an arc second throughout a four or five hour test run. This require- 
ment was met by constructing a thermally passive source consisting of a 
Davidson (Model D-278) reflective bench and low power LED point sources. 
Since every part of the source was essentially at room temperature, no 
thermal deformations were possible. 

The optics consist of a parabolic primary mirror with a focal length 
of 272 cm, and a flat secondary mirror. The aperture diameter is 40.6 cm 
with a center obscuration of less than 5.1 cm diameter. 

The LED point sources are mounted in an aluminum plate which has a 
glass photographic plate bonded to its front side. The star images are 
formed by the photographic plate. Figure 4-20 illustrates the angular size 
and spacing of the three stars used in the strapdown system test. The 
vertical reference in the figure is the gravity vector with the plate in 
position for the strapdown test, and the stars as seen looking into the 
star source. The measurements were made with the Kern DKM3 theodolite. 





The theodolite was placed in the same position In the collimated beam 
occupied by the strapdown star tracker. Each angle is the average of three 
measurements. Of the six angles the maximum standard Cieviation about the 
mean is 0.4 arc second; the peak deviation from the mean is 0.9 arc second. 
Using the maximum standard deviation, the standard deviation of the mean is 
0.2 arc second. 

For the gimbal test the center star was used together with a number of 
mirrors to produce the three different star elevations. A stationary mirror 
and three rotating mirrors were used to deflect the star beam. The mirrors 
were adjusted so that the star beam was normal to each of the three refer- 
ence mirrors on the side of the gimbal star tracker base. This was accom- 
plished by first adjusting the star beam parallel to the automatic auto- 
collimator beam, and then adjusting the rotating mirrors so that the 
autocollimator beam was normal to each reference mirror face. Immediately 
following this adjustment, the tracker was removed, the theodolite inserted 
in its position, and the three star angles were measured. Figure 4-21 
illustrates the measured angles. The reference axes are the gravity vector 
and an arbitrary azimuth. Each angle is the average of three measurements. 
The maximum standard deviation of the six angles is 0.7 arc second; the 
peak deviation from the mean is 1.0 arc second. Using the maximum standard 
deviation, the standard deviation of the mean is 0.4 arc second. The 
increase in measurement error over that obtained for the LED sources was 
due to two effects: 

1) A drift trend in the measurements, probably due to motion 
of the deflection mirrors 

2) Less precision in centering the theodolite crosshairs over 
the square star which was tilted for the gimbal tests.. 

The stars were made square to improve the repeatability of the field 
of view positioning of the theodolite. Figure 4-22 shows the. vertical 
crosshairs of the 0KM3 positioned over a star. The star was made large 
enough so that a strip approximately 2 arc seconds wide appeared outside 
of the crosshairs. The operator would position the instrument so that both 
strips appeared equal in width. A 0.5 arc second error in centering would 
produce an easily discernable 60 percent difference in strip widths. 
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Figure 4-22. Theodolite Field of View Centering 

The drawback in making such large stars is the susceptibility to non- 
unformities in the illumination within the 28 arc second star. Although 
the stars appeared uniform visually, there is no assurance that the centroid 
in the spectral bandwidth of the star tracker will be at the geometrical 
center of the star. Based on experience gained from the unit calibrations 
of the strapdown star tracker (Volume II, Section 7) , a 4 percent error, 1.0 
arc second (la), was attributed to this source. Although the error could 
be measured by noting the star tracker output before and after rotating 
the star 180 degrees, this was not done because of the irrelevance of the 
error to the PADS test results. 

Again, because of the objective of the PADS tests, it was technically 
justifiable to use LED sources instead of light with a soectrum more nearly 
approaching that of starlight. The intensity of the LED was adjusted to 
give the semie anode current from the image dissector in the star tracker 
that the convolution of starlight (60, 6000°K) with the nominal S20 photo- 
cathode response would produce. For the strapdown tracker, 8 stars v/ere 
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simulated; the gimbal tracker used 3.5 stars. The tracker performance, 
and hence the PADS performance, Is a function of the anode current, and is 
insensitive to the spectrum of the light producing the current, providing 
the intensity is such as to always produce the same current. 

The collimation accuracy of the reflective bench is specified to be 
2 arc seconds over the entire 40.6 cm aperture. Using the center star 
(on the focal axis), the collimation was checked around the area of the 
tracker and theodolite apertures shown in Figure 4-23. The theodolite 
together with a separate reference mirror mounted on the granite table was 
used. No collimation error, significant relative to the repeatability of 
the DKM3, was observed. 

In the case of the strapdown test, a collimation error is caused by the 
top and bottom stars not being on the focal axis of the parabolic mirror. 
However, this did not cause a test error since the relative star positions 
were measured with the theodolite in the same position occupied by the 
star tracker. 
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Figure 4-23. Aperture and Mirror Geometry 
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4. 4. 2. 2 Double-Sided Mirror 


The double-sided mirror is a Davidson (Model D-616) adjustable refer- 
ence mirror. By manufacturer specification the two first-surface mirrors 
are parallel to within one arc second. 

Non-parallelism between the two mirror surfaces will result in a one- 
to-one non-parallelism between the center star bean and the automatic auto- 
collimator beam. This will appear as an absolute error common to all stars. 
Since this type of error is not relevant to detertrilning the performance of 
the PADS systems, the parallelism was not checked in the laboratory, 

4. 4. 2. 3 Theodolite 

The theodolite serves two functions: 

1) Alignment of the center star and automatic autocollimator 
beams to a parallel condition 

2) Measurement of the relative angles between the three stars 
used in both the strapdown and gimbal system tests. 

These functions are the limiting factors in the accuracy of the laboratory 

instrumentation for the PADS tests. Consequently, the Kern Model DKM3 

theodolite was used throughout the testing since it provides significantly 

f 5l 

better readout precision than other theodolites.' ‘ 

Alignment of the star and autocollimator beams involves two steps: 

1) Centering of the star in the telescope crosshairs 

2) Adjustment of the double-sided mirror to center the auto- 
collimating reticule return image in the crosshairs. 

Although the micrometer readout was used to facilitate the first step, final 
verification of the alignment was through the telescope eyepiece and was 
independent of readout repeatability errors. 

Repeatability in centering either the square star image or the reticule 
image in the crosshairs was measured indirectly by making two sets of mea- 
surements: 

1) Sixteen micrometer readings wherein only the micrometer 
was moved after each reading 

2) Sixteen micrometer reading wherein both the micrometer and 
the telescope were moved. 
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No statistically significant difference in the standard deviations of the 
two sets of readings vas observed. The conclusion reached was that the 
centering repeatability is better than the readout repeatability. The 
latter falls within the range 0.2 to 0.4 arc second (lo), depending on the 
ability and disposition of the observer. Arbitrarily, the centering 
repeatability was assigned the value 0.2 arc second (lo). 

A bias error In the alignment of the two beams can be introduced by 
the autocollimation technique used in the DKM3, A cube beamsplitter is used 
and the crosshair pattern and the autocollimating negative reticle are fixed 
to the sides of the cube. Coincidence of the telescope and autocollimating 
boresights was measured by first aligning the star and double-sided mirror, 
and then plunging and reversing the theodolite and measuring any indicated 
deviation. The misalignment between boresights was found to be 0.7 arc 
seconds for the horizontal axis and negligible relative to the readout 
repeatability for the vert i cl e axis. 

A final error source which must be considered in the alignment of the 
two beams is the spherical abberation of the DKM3. This error arises 
because half the aperture of the telescope is covered by the double-sided 
mirror. It was minimized by adjusting the telescope focus so that no 
discernable star motion was observed with either a full aperture or half- 
covered aperture. Once set, the focus was not moved throughout the ten day 
system test. 

Measurement of the angular position of the top and bottom stars relative 
to the center star is subject to three types of errors: 

1) Micrometer readout repeatability 

2) Horizontal and vertical circle accuracy 

3) fjrizontal axis runout {gimbal test only). 

The first error can be minimized by repeated readings. No instrumentation 
was available to measure the second error. However, circle accuracy for the 

/g\ 

DKM3 instrument has previously been measured' ' as 0.2 to 0.3 arc second (lo). 
Arbitrarily, 0.2 arc seconds (la) was assumed. Since the three stars for 
the gimbal system test are approximately 20 degrees apart, bearing runout 
in the horizontal axis of the theodolite is a factor. Unfortunately, no 
information is available for this error source. 
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Leveling of the theodolite can easily be accomplished within one or 
two arc second. In the case of the three stars for the strapdown system 
test, where the maximum star separation is 911 arc seconds, this is a 
negligible error source. For the three stars in the gimbal system test 
this error source is irrevalant since only the relative star positions 
are measured with the theodolite. Their absolute alignment relative to 
the gimbal star tracker axes is determined using the star sensor boresight 
as explained in Section 10.2. 

4. 4. 2. 4 Air Bearing Table Readout 

The air bearing table and readout electronics are made by Fecker 
Systems Division, Owens-Illinois. The performance parameter critical to 
the PADS system tests is the stability of the angle readout. This readout 
is a 21 bit digital word with a scaling of 360°/2^^ counts, or approximately 
0.6 arc second/count. 

Following a four hour warmup period, the stability of the readout was 
checked by positioning the table so that an equal motion in either direction 
was required to change the readout by one bit. No change in the readout was 
noted thereafter for periods up to 24 hours. 

For the strapdown system test the table readout is used over a 1/2° 
interval to provide a laboratory measurement of the horizontal location of 
a star in the tracker 1° by 1° field of view. Consequently, the readout 
was calibrated over this range using two different makes of theodolites to 
provide independent references. A Kern DKM3 and a Wild T3 were the 
theodolites used in the calibration. 

Five calibrations were made using the T3 over a period of 12 days. 

Two months later iree calibrations were made with the DKM3. A different 
section of a ' ■. dolite circle was used for each calibration with that 
instrument. 

The results of the T3 and DKM3 calibrations are shown in Figure 4-24. 
The agreement befaveen theodolites is excellent. The temporal stability of 
the error is also high since the curves were taken two months apart. 
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A 256 cycle error is expected in the readout since a 512 pole Inducto- 
syn is used. Consequently, the data in Figure 4-24 was modeled as 



where 

N = 11 

A6 = 188 arc seconds 

= 5062.5 arc seconds 
P 

The observation equation for all data points representing the average of 
the two curves in Figure 4-24 is 

y = Ax 

The best fit in the least squares sense is 

X = ( a '^' a )"'' A^y 

Solution of this equation using a computer program gave the parameters 

x-j = —0.8 

Xg = 1.2 

= 0.8 

The standard deviation of the residues between the model and the 11 data 
points was 0.1 arc second. 
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In the case of the strapdown system test a total of three measurements 
in the field of view were made per star transit. Consequently, the optical 
angle (twice the table angle) quantization is 

n = 3 2(0.6) 

^ " /3 /12 

Qg = 0.6 arc second (3 ct) 

For the gimbal system test a single measurement is taken per transit. 
In addition, the optical and table angles are the same. The quantization 
is then 



Qg = 0.5 arc second (3a) 

The response of the table readout to a constant rate is 1 arc sec per 
rad/sec. Since the maximum table rate during testing was 15 arc seconds/ 
second, the lag in the angle readout is negligible. 

4. 4. 2. 5 Automatic Autocollimator 

The two-axis autocollimator used in the PADS tests was a Davidson 
(Model 696) Automatic Autocollimator. The excitation of the output poten- 
tiometer was adjusted to give a scaling of 0.15 v/arc second. 

For all of the test runs the output of either axis of the autocollima- 
tor never exceeded ten arc seconds. Since the excitation voltage was con- 
trolled to better than 1 percent, the scale factor error never exceeded 
0.1 arc second. Of greater importance was a nonlinearity in the poten- 
tiometer output for the horizontal axis near null. This error amounted to 
0.3 arc seconds deviation from an otherwise linear output. 

The noise in the autocollimator output was filtered through a 20 sec- 
ond RC time constant mechanized in the digital computer. This reduced the 
noise level to 0.2 arc second (peak). 
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With the parallel beam star stimulus technique the bias drift of the 
autocollimator is calibrated before each star transit. This is accomplished 
by first directing the star and autocollimator beams at the theodolite and 
double- sided mirror and measuring the autocollimator bias. Next the beams 
are directed at the star tracker. A change in output between positions 
indicates the angle between the star beam and the normal to the reference 
mirror surface on the tracker. 

The maximum drift of the autocollimator output observed during any of 
the eight test runs was 2 arc seconds for a four hour period. Sinco it 
took approximately 5 minutes of data to measure the steady-state output 
values at the reference and star positions, the effect of the drift was 
negligible. 


4-34 


5. TEST FACILITY DESCRIPTION 


A general description of the PADS precision test facility is presented 
in this section. The facility layout, test equipment, and electronics are 
discussed. 

5.1 FACILITY LAYOUT 

The PADS precision test facility is located in TRW Building H5, 

Room 0222, Manhattan Beach, California. The test facility consists of 
four areas: 1) a laboratory, 2) a control platform, 3) a computer area, 

and 4) a work area. Figure 5-1 is a floor plan of the facility. 



Figure 5-1. Test Facility Floor Plan 

The laboratory is a dark room which is located on a seismic pad 
isolated from building vibrations. The pad rests on a sand base. The 
laboratory has its own air conditioning system which controls the air 
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temperature to 0.6“C. Whenever it was practical, all heat generating test 
equipment was located on the control platform to minimize thermal gradients 
within the laboratory. Equipment installation settling times greater than 
60 days were allowed for both rotary tables, the granite tables, and the 
star source. 

All electronic equipment necessary to monitor and control the system 
tests was located on the control platform. This area functioned as the 
center of activity throughout a test run. 

The computer area contained the CDC 1700 digital computer and two 
computer control terminals. Although this computer implemented the con- 
trol of various equipment during a test run, control of the computer it- 
self was exercised from switches on the control platform. The terminals 
were used to initialize the program before a test run and for debugging. 

A photographic montage of the facility is shown in Figure 1-3. The 
top photograph (a split photo) shows the inertial reference unit on the 
left together with its console and the rate table console. Since a 
ground-fixed test method was used, the rate table console was inoperative 
during all test runs. The star trackers and their associated test equip- 
ment are shown on the right. The test console shown on the rear wall is 
for unit testing of the strapdown star tracker and was also inoperative 
during the test runs. In addition to the two electronic consoles on the 
control paltform, two stripchart recorders were present to display quick 
look data, an oscilloscope for troubleshooting electronic failures, and a 
desk and bookcase for data storage. 

5.2 LABORATORY TEST EQUIPMENT 

The test equipment used in the laboratory for both the strapdown and 
gimbal system tests is listed in Table 5-1. The item numbers refer to the 
balloon numbers in Figures 4-2 and 4-3 which are isometric drawings of the 
laboratory configurations. Items 28 through 31 are not shown in the fig- 
ures. Item 28 is a shutter to block the autocollimator light beam from 
entering the star tracker aperture. Items 29 through 31 were used for 
initial alignment of the laboratory equipment. Item 32 monitored the 
laboratory temperature. 
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Table 5-1. Laboratory Equipment 


Strap Glm 


Relevant SpecTfication 


Star Source 


LED Point Sources 


Davidson Reflective Benfcb 
Model D-278 


2 arc sec colHmation accuracy 


L-, i 


Autocol lima tor Stand 
Automatic Autocol! Iina tor 
Adjustable Mirror 
Rotating Mirror 
Mirror Mount 
Air Bearing Table 


Theodolite 


Adjustable Mirror 

Mirror Stand, Strapdown Test 

Granite Table 

■ Granite Slab 
Strapdown Star Tracker 

Optical Cube 
Star Tracker Stand 
: Rate Table 

Inertial Reference Assembly 
Deflection Mirrors 
Rotating Mirror Fixture 
Stationary Mirror Fixture 
Reference Mirrors 
Global Star Tracker 
Granite Riser 
Granite Block 
Mirror Stand, GimbaT Test 
Shutter Assembly 
Theodol 1 te 
Vertical Mirror 
Bubble Level 

Temperature and Humidity 


Davidson Model D-696 
Davidson Model D-616 
Ransom 10 in. diameter 


Fecker Dwg 256-001 
Kern Model omi 


Davidson Model D-616 


Collins Microflat 
Collins Mlcroflat 


Mark Optical 


Inland Model 712 
NASA/GSFC OAO 
Ransom 10 in, diameter 


Collins Microflat 
Collins Microflat 


Farrand No, 8850A 
Starrett No. 199 
Honeywell 


0.1 art sec resolution 
1/8 wavelength flatness 
1/10 wavelength flatness 


0.6 arc sec readout resolution 
0.2 arc sec accuracy 
1/8 wavelength flatness 


1/8 wavelength flatness 


1/10 wavelength flatness 


1/8 wavelength flatness 


0.2 arc sec accuracy 
2 arc sec to vertical 
1 arc sec resolution 
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5.3 ELECTRONIC EQUIPMENT 


The general approach to the design of the electronics was to provide 
redundancy and to avoid interdependence of equipment. The intent of both 
of these ground rules was to avoid delays during the equipment integration 
phase. Redundancy was provided for both the strapdown star tracker and 
the gyro readouts by having their unit test consoles on hand. This allowed 
their integration in the laboratory without dependence on the facility 
electronics. The facility electronics had the capability to duplicate the 
computer commands, thereby allowing operation of the laboratory equipment 
while the computer programs were being debugged. Operation of the equip- 
ment without either of the star trackers, or the gyros, was provided in 
order to avoid delays in the case of a malfunction of any of the units. 
Since it was a critical element, a backup automatic autocollimator was on 
hand. A complete supply of electronic components was maintained in the 
facility. 

A block diagram of the electronic equipment in the PADS test facility 
is shown in Figure 5-2. An explanation of the acronyms used is given in 
Table 5-2. Figures 5-3 through 5-9 are photographs of the electronics 
located on the control platform. Functional descriptions of the panels 
in the two consoles are given in the following paragraphs. 

AA/CP . This panel, supplied by Davidson Optronics, controls the 
automatic autocollimator unit in the laboratory. After intially setting 
the track loop gains, the panel was used only to indicate acquisition of 
an optical flat by the autocollimator. 

ABP . This panel performs two functions; 1) it provides the servo 
electronics to drive the ABT, and 2) it supplies the excitation and buffer 
amplifiers for the AA/C potentiometers. 

The computer supplies two analog voltage commands, position and rate, 
to the servo electronics. The electronics implements a proportional plus 
integral drive to the ABT power amplifiers. A potentiometer is available 
on the panel to sum a voltage in with the computer position command. This 
capability allows manual positioning of the table. 
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Table 5-2. Electronic Interface Acronyms 


AA/C 

Automatic Autocollimator 

OSC 

Oscilloscope 

AA/CP 

AA/C Control Panel 

OSU 

Optical Sensor Unit 

ABP 

Analog Buffer Panel J 

P-S 

Parallel to Serial 

ABT 

Air Bearing Table 

PCP 

Power Control Panel 

BUF 

Buffer 

PWR 

Power 

CDU 

Control Room Display Unit 

RCDR 

Recorder 

CMD 

Command 

R/0 

Readout 

CMP 

Console Monitor Panel ‘ 

RPP 

Remote Patch Panel 

DDU 

Darkroom Display Unit 

SA 

Shutter Assembly 

DEA 

Digital Electronics Assembly 

S Box 

Speaker Box (Intercom) 

OTU 

Data Transfer Unit 

1 

SCP 

Shutter Control Panel 

DVM 

Digital Voltmeter i 

S-P 

Serial to Parallel 

EOA 

Electro-Optical Assembly 

SEA 

Sensor Electronics Assembly 

FI 

Fast Input 

SI 

Slow Input 

GRA 

Gyro Reference Assembly 

SO 

Slow Output 

GST 

Gimbal Star Tracker 

ss 

Star Source 

INDUC 

Inductosyn 

SSCP 

Star Source Control Panel 

IRU 

Inertial Reference Unit 

ssu 

Star Sensor Unit 

LEDA 

Light Emitting Diode Assembly 

TTY 

Teletypewriter 

MTR 

Motor 

UP 

Utility Panel 


The excitation to the AA/C potentiometers is independently adjustable. 
A scale factor of 0.15 volt/arc second was used. The buffer amplifiers 
send the potentiometer outputs to the computer. 


CMP . This panel monitors the gimbal motor current, the SST analog 
deflection signals, and eight DAC channels from the computer. The SST 
deflection signals were displayed on the oscilloscope. The DAC channels 
were displayed on the stripchart recorder via the UP. 

UP . This panel provides direct connection to the two stripchart 
recorders. An eight channel and a six channel recorder are available. 
The eight channel was used for quick look information during a test run. 
The six channel was for long term monitoring of the gyro performance be- 
cause it could be operated at a very slow chart rate. 
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Control Platform View 


Figure 5-4. Control Platform View 
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Figure 5-7. PCP Panel and Power Supplies 


Figure 5-8. SCP to DTU Panels 











Figure 5-9. DTU and OSU Panels 


PCP . This panel provides independent switching of the dc power sup- 
plies to the other panels and equipment. The purpose is to avoid power 
supply turn-on transients. 

SCP . This panel operates the shutter in front of the AA/C. Since 
it was essential to avoid having the AA/C light beam enter the strapdown 
star tracker, a fail-safe light indicator is inserted in the panel to sig- 
nal shutter closure. 

DTU . This panel performs four functions: 1) it transfers all digi- 

tal signals from the ABT, GST, S5T, and IRU to the computer, and 2) it 
transfers digital signals from the computer to the ABT electronics, GST, 
and SST, 3) it displays digital information from the computer and from 
the ABT, GST, SST, IRU, and 4) it provides commands to the comput'."" 
program. 
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Digital data transfer into the computer is accomplished at two rates: 
1) 6 msec/v/ord (FI), and 2) 50 msec/word (SI). The ABT and GST gimbal 
angles are sent at the fast rate. SST deflection and magnitude, three 
gyro outputs, and a status word are sent at the slow rate. 

Data transfer from the computer is accomplished on one channel (SO) 
at the rate of 50 msec/word. A command word and two memory peek words are 
transmitted. Individual bits of the command word are sent to the ABT 
electronics, the GST, and the SST. The memory peek words display program 
selected memory locations in the computer. 

Any of the above digital words can be shown on the LED display on 
the panel by using the selector switches. This information can also be 
duplicated on a similar LED display in the laboratory. 

In order to minimize operating personnel, the computer program was 
designed to be operated from the DTU by the test conductor. This is 
implemented from eight switches on the panel which set the state of eight 
bits in the status word sent on the SI channel. 

An optional capability of the DTU is the ability to function without 
the computer. This allowed display of the ABT, GST, 6RA, and SST signals 
while the computer was being used for other tasks. 

OSU . This panel displays the status of the SSU. It also has a 
switch to enable the SSU high voltage supplies. The SSU analog deflec- 
tion signals were displayed on the oscilloscope. 

AST ENCODER ELECTRONICS . This panel, supplied by Pecker, provides 
a visual display of the 21 bit digital word indicating the table angle. 

It also sends this word in parallel to the DTU. 

t ABT MOTOR ELECTRONICS . This panel functions as a power amplifier 
to drive the ABT motor. 

In addition to the above described panels a MODEM panel in the 
CDC 1700 computer was designed. This panel functions both as a signal 
buffer and as a serial/parallel digital word converter. 

The CDC 1700 computer has the capability of transmitting information 
to the Varian V73 computer. This capability was used to store the PADS 
test run data using the magnetic tape unit on the V73. 
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6. DATA HANDLING AND DISPLAY 


Data was generated during the PADS system test from two sources: 
the PADS sensors and the laboratory instrumentation. This is illustrated 
in Figure 6-1. The data was collected for two purposes: 1) to provide 

the basis for the evaluation of the performance of the PADS system under 
test, and 2) to provide real time diagnostic data to indicate the validity 
of the test. 

All data was transmitted to the CDC 1700 computer via the data trans- 
fer eTectronics. The data necessary for the evaluation of the PADS system 
was stored on magnetic tape. This data was transmitted to the V73 computer 
over data lines for storage on the tape since the CDC 1700 did not have a 
magnetic tape unit. The real time diagnostic data was displayed during a 
test run on an eight channel stripchart recorder via the test display 
electronics. 

The following sections describe in detail the test performance and 
real time diagnostic data which was collected. 


REAL TIME DIAGNOSTIC DATA 



Figure 6-1. Data Handling and Display 
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6.1 TEST PERFORMANCE DATA 


Three types of performance data were stored on magnetic tape for both 
the strapdown and gimbal system tests. These are listed in Table 6-1. 

PADS data consists of the gyro and star tracker signals. This information 
is used in the PADS algorithms to estimate the inertial attitude of the 
PADS axes. Lab data consists of the air beaming table angle and automatic 
autocollimator differences. This information, together with pretest mea- 
surements, identifies where the star is relative to the PADS axes, and, 
ultimately, the true inertial attitude of the PADS axes. Boresight data 
consists of filtered star tracker and automatic autocollimator signals. 

In essence it measures the static boresight stability of the tracker. 


Table 6-1. Types of Performance 


Data Word 

PADS 

Data 

Lab 

Data 

Bores 

Djta 

Strapdown System Test 




T 

X 

X 


GRAX 

X 



GRAY 

X 



GRAZ 

X 



SSTX 

X 



SSTY 

X 



ABTA 


X 


AAA/CX 


X 

X 

AAA/CY 


X 

X 




X 

§5?Y 



X 

Gimbal System Test 




T 

X 

X 


GRAX 

X 

X 


GRAY 

X 



GRAZ 

X 



GSTX 

X 



GSTY 1 

X 



GSTA 

X 



ABTA 


X i 


AAA/CX 


X 

X 

aaa/cy 


X 

X 




X 

gsTy 



X 

^TA 

J 

L .. . 

X 

1 


t 


The first two data types provide the basis for the evaluation of the 
PADS performance; namely* the difference between the estimated PADS atti- 
tude from the sensor information and the true attitude from the laboratory 
instrumentation data. The third data type was included for two reasons: 

1) to provide a check on the validity of the lab data accuracy, and 2) to 
measure the bores icjht stability of the star trackers throughout the test 
period. 

Data was collected every second for both system tests. The word T 
is the time tag. The three-axis gyro information, GRAX, GRAY, and GRAZ, 
was collected continuously throughout the test run. Every 20 minutes, 
during a star transit, the star tracker information was collected. For 
the strapdown tracker the horizontal and vertical positions of the star 
in the field of view, SSTX and SSTY, were stored. The same signals for 
the gimbal star tracker, GSTY and GSTX, were collected, along with the 
gimbal angle, GSTA. The air bearing table angle, ABTA, was also col- 
lected during a star transit. The duration of the transit was approxi- 
mately four minutes for the strapdown test and two minutes for the gimbal 
test. As described in Section 4.3 the autocollimator bias was calibrated 
prior to each star transit by pointing the parallel star and autocolli- 
mator beams at the theodolite and double-sided mirror. Following this 
calibration the static orientation of the star relative to the PADS axes 
was checked by pointing the parallel beams at the star tracker and its 
reference mirror surface. The star orientation was indicated by the 
autocoll imator outputs, minus the bias errors, namely, AAA/CX and AAA/CY. 
With the star pointed at the tracker, the output signals from the tracker 
were also collected: SSTX and SSTY for the strapdown tracker, and GSTY, 

GSTX, and GSTA for the gimbal tracker. The bar over these signals indi- 
cates that they are filtered to minimize their noise content. These fil- 
tered signals were stored once at the start of each star transit. 

It is noted that the horizontal star position is indicated by the 
signals SSTX, GSTY, and AAA/CX; the vertical by SSTY, GSTX, and AAA/CY. 
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All data was converted Into engineering units in the V73 computer 
before storage on the magnetic tape. Time was carried to a precision of 
0.001 second, and all angles were carried out to 0.1 arc second. For a 
four hour run, with 12 star transits, the number of words stored on tape 
was approximately 78,000 for the strapdown system, and 69,000 for the 
gimbal system. 

In the case of the gyro data the accumulated attitude was transmit- 
ted from the gyros and stored on tape. The advantage of this approach, 
compared to transmitting the incremental attitude, was that a random 
transmission error would not invalidate the long term knowledge of gyro 
attitude change. 

6.2 REAL TIME DIAGNOSTIC DATA 

The real time diagnostic data provided a continuous indication 
throughout a test run that the functional operation of the hardware was 
proper and that, with a high degree of probability, the test data being 
collected was valid in terms of indicating the PADS performance. This 
information was considered necessary in view of the length (4 to 5 hours) 
of the test runs. It eliminated any time which would have been wasted by 
continuing to run invalid tests. 

The different types of diagnostic data that were used are listed 
in Table 6-2. All of the performance data signals listed in Table 6-1 
were monitored by the stripchart recorder, the ABT readout, and the DTD 
LED display. The teletypewriter and the CRT display provided error mes- 
sages indicating either a procedural error by the test conductor or a 
data transmission error. 
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Stripchart Recorder 


Channel 

Strapdown Test 

Gimbal Tes 

1 

A GRAX 

A GRAX 

2 

A GRAY 

A GRAY 

3 

A GRAZ 

A GRAZ 

4 

SSTX 

GSTX 

5 

SSTY 

^Y" 

6 

AA/CX 

AA/CX 

7 

AA/CY 

AA/CY 

8 

ERROR 

ERROR' 


Air Bearing Table Readout 
ABTA 

DTU Led Display 

COC 1700 Teletypewriter 

Operator Error Message 
V73 CRT Display 


Transmission Error Message 




The stripchart recordings for the four strapdown system test runs 
and the four gimbal system test runs are included in Appendix D. The 
gyro signal, AGRA, is the attitude change over a 100 second time period. 
The filtered horizontal and vertical autocollimator signals are AA/CX 
and AA/CY, respectively. The signal ERROR is the filtered difference 
between the star tracker horizontal axis signal and the air bearing 
table angle, biased to zero at the center of the tracker field of view. 
This signal occurred only during a star transit. The square wave dis- 
cernible in the autor.ol limator signals reflects the two positions, one 
with the parallel beoms pointed at the theodolite, the other with the 
beams pointed at the star tracker. The majority of the time between 
star transits was spent at the latter position. A peculiarity in the 
gyro data is that occasionally the digital to analog converter in the 
CDC 1700 will turn over if the signal is near +^10 volts. The result is 
a discrete change of 10 volts in the recorder output. This can be ob- 
served, for example, in the GRAZ signal in the first strapdown system 
test on 1 October 1975. 

The air bearing table angle was observed during the test directly 
from the Fecker readout display. The gimbal angle was observed on the 
DTU LED display. 

If the test operator followed an incorrect sequence in switching 
between program modes, the computer program printed an error message at 
the teletypewriter. 

To provide a final data check before storage of the data on magnetic 
tape, the V73 computer program performed a check on tne time word, T, to 
verify that one second occurred between successive words. 
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7. LABORATORY COMPUTER PROGRAMS 


Two categories of computer programs were written for the CDC 1700 
computer in the PADS test facility. The first provided for a step-by- 
step integration and checkout of the laboratory and system equipment. 

The second category consisted of the system test programs for the stv’ap- 
down and gimbal system tests. These two programs are described in detail 
in this section since they are essential to a complete understanding of 
the tests. 

The purpose of either system test program was twofold: 1) to pro- 

vide star stimuli to the star tracker; and 2) to collect, store, and 
display the signals from the PADS sensors and the laboratory instrumen- 
tation, The star stimuli consisted of individual star transits in which 
a collimated star beam was moved past the field of view of the star 
tracker at earth rate. The frequency of the star transits as well as 
the length of the test were determined by the test conductor. All data 
was time- tagged and stored on magnetic tape. Separate programs were 
written for the strapdown and gimbal system tests due to the differences 
in operation of the star trackers. The programs were named SUE and GWEN, 
for the strapdown .ind gimbal tests, respectively. 

Flow diagrams of the two programs appear in Appendix E, 

7.1 STRAPDOWN SYSTEM TEST PROGRAM 

The following sections describe the modes, data displays, and data 
collection capabilities of the strapdown system test pr-gram SUE. 

7.1.1 Program Modes 

There were three main program modes in SUE: 

MODE 1 - REFERENCE POSITION . The Star source (SS) and automatic auto- 
collimator (AA/C) beams were pointed at the theodolite and reference 
mirror by the 1700 computer closing a servo loop about the ABT R/0 to 
drive the ABT to a reference position, ABTO = 7710000. The difference 
between the readout, ABTA, and ABTO was output as a position signal, 

POS, to the servo electronics by a 1700 DAC channel every 3 milliseconds. 
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Expressed in equation form. 


POS = ABTO-ABTA, |P0S| < 2047 bits 

POS = 2047 sign (POS), jPOSj > 2047 bits 

where 

1 bit = 0,617981 arc sec 

Although a rate command channel was available, it was set to zero. 

MODE 2 - ZERO POSITION . The SS and AA/C beams were pointed at the 
strapdown star tracker (SST) by the 1700 closing a servo loop around ti.e 
ABT R/0 to drive the ABT to 0010000. Position and rate were commanded 
as in MODE 1. 

MODE 3 - STAR TRANSIT . The purpose of this mode was to drive the 
ABT at half earth rate to sweep a simulated star across the field of view 
of the star tracker. Before starting this sweep, the ABT was driven from 
the ZERO position of MODE 2 to the starting position which places the star 
outside the field of view. The complete ramp function generated in the 
1700, using its clock as a time reference, is defined graphically in 
Figure 7-1. The ramp is continued until tha mode is manually exitM by 
the test conductor. The servo position command, computed and outpuc 
every 3 milliseconds was: 

POS = (RAMP + ZER0P)-ABTA 

where 

ZEROP is the ZERO position of MODE 2 
and RAMP is the function in Figure 7-1. 

There were two submodes in SUE; 

RUNNING AVERAGES . This submode, when exercised, computed running 
averages of both AA/C outputs and, if the star tracker was in track, both 
SST digital outputs. This submode could only be entered from MODE 1 or 
MODE 2. When exited the last values of the running averages were stored 
in memory, one pair for each mode in the case of the AA/C. Lince SST out- 
puts were available only in MODE 2, only one pair was stored. 


7-2 


RAMP 



DATA COLLECTION . This submode sent data to the V73 computer to be 
stored on magnetic tape. It could be entered or exited from any of the 
three main modes. Its normal duration was four hours and constituted a 
"test run." Since a time base was required for the test run, the 1700 
clock was initialized and started when the submode was entered and stop- 
ped when it was exited. Therefore the exercise of the clock dependent 
functions, the ramp and the one second period for some of the running 
averages, required this submode to be active. 

7.1.2 Mode Control 

The teletypewriter was used only to start and stop the program. 

All other control was from four manual switches on the DTU. The switch 
logic for mode control is shown in Table 7-1. Switch No. 3 controlled 
the RUNNING AVERAGES submode. Switch No. 4 controlled the DATA COLLECTION 
submode. The switch positions were transmitted to the 1700 computer via 
the lower order four bits of the slow input status word. A one corres- 
ponded to the "UP" switch position. 
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Table 7-1. SUE Mode Control 


Description 


No. 1* 
Bit 0 


Switch Number 


Reference Position 
Zero Position 
Star Transit 


Slow input status word 
7.1,3 Proqram Di screte Commands 


The program set the discrete commands from the digital output chan 
nel to the states indicated in Table 7-2. 

7.1.4 Real Time Diagnostic Data 


Table 7-3 lists the parameters that were sent to the stripchart 
recorder through the DAC channels of the 1700 computer, for display during 
the test. 

Table 7-2. Discrete Command States 


Slow Output 
Bilevel Command Word 
Bit Number 


Description 


State 


SST Search 
ABT Integ Enable 
ABT MTR Inhibit 


All Others 












Table 7-3. DAC Output Data 


DAC 

Data 

Type 

Update Period 

Scaling 

4 

AGRAX 

Incremental Count 

100 sec 

0.1 V/count 

5 

AGRAY 

Incremental Count 

100 sec 

0.1 V/count 

6 

AGRAZ 

Incremental Count 

100 sec 

0.1 V/count 

7 

SSTX 

Running Average 

50 msec 

0.5 V/count 

8 

SSTY 

Running Average 

50 msec 

0.5 V/count 

9 

AA/CX 

Running Average 

1 sec 

0.25 V/arc sec 

10 

AA/CY 

Running Average 

1 sec 

0.25 V/arc sec 

n 

ERROR 

Running Average 

50 msec 

0.5 V/count 


An explanation of each data type is given below: 

AGRA . These are the differences in the 16 bit gyro word at a 
100 second interval. The scaling (1 meru = 0.015°/hr) is: 

0.05 meru = 1 count/100 sec 

Since the maximum difference {at full earth rate) would be 20000 
counts, less than half the capacity of a 16 bit word, differences could 
be taken without accounting for turnover of the gyro word. On the other 
hand, the DAC word, scaled for 0.1 V/count and limited to +10 V, could 
turn over. 


SST. These are the running averages of the 12-bit star tracker 
outputs. They are computed every 50 millisec by the equation: 

^N+l = n - e) SST„ + e (SST„^,) 

where 

e = 0.001 

These averages were computed only in MODE 2, and were stored upon exit 
of the RUNNING AVERAGE submode. 
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AA/C . These are the running averages of the autocollimator outputs. 
They were computed every one second by the equation: 

= (1 - e) mrq + e (AA/Cj^^^) 

where 


e = 0.05 

These averages were computed in MODE 1 and MODE 2, and were stored sep- 
arately upon exit of the RUNNING AVERAGES submode. 

ERROR . This is the running average of the difference between the 
SST horizontal axis output and the ABT readout. It is computed every 
50 millisec by the equations: 

ERROR = SSTX - 1.236 (ABTA) 

™^N+1 = + e (SST^^^) 

where 


e = 0.04 

This average was computed only in MODE 3 when the star tracker was in 
track. 

7.1.5 Data Collection 

Collection of data to be transmitted by the 1700 computer to the V73 
is initiated by DTU switch 4 in the up position. There are three different 
data formats. Table 7-4 lists the data to be- sent for each format. 

Note that "Track" actually implies two conditions: 1) that the SST 
Search/Track signal indicates track, and 2) that the positive ramp in 
MODE 3 be present. "Start of track" is the first time the 1 sec counter 
changes after entry into track as defined above. "Non-track" is all the 
rest of the time. 
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Table 7-4. Data Stored on Magnetic Tape 


i 

Data j 

Nominal 

Scaling 

i 

! Bits 
1 Required 

i 

Non-Track 

start of 
Track 

r ■ - 

Track ' 

1/Sec 

Single 

1/Sec 

1 

1 

Time | 

1 msec/cnt 

1 19 

X 

X 

X 

GRAX 1 

0.075 s^/cnt 

: 21 
1 

X 

X 

X 

GRAY 1 

0.075 sec/cnt 

21 

X 

X 

X 

1 GRAZ 1 

0.075 sec/cnt 

; 21 

X 

X 

X 

' SST X/y Status ' 

-- 

1 ; 


X 

X 

1 SSTX 

1 ,0 sec/cnt 

12 j 


X 

X 

j SSTY 

1 .0 s^/cnt 

12 ^ 


X 

X 

' ABTA ; 

0.618 ^/cnt 

21 ■ 


X 

X 

1 SSTX 

1 .0 ^/cnt 

' 12 


X 


■ SSTY 

1 .0 sec/cnt 

12 


X 


1 AAA/CX 

0.15 s^/volt 

12 


X 


m/cy ; 

0.15 sec/voH 

; 12 ; 


X 



Comments regarding the data are: 

9 TIME AND STATUS . Time must have at least 21 bits to record 
4 hours of data at 10 msec/count. Time will be zero at the 
start of data collection. The three status bits are: 

1) Search/Track (SI, Status, Bit 5) 

2) X/Y Data (SI, Status, Bit 6) 

3) Initial Track (True at start of track). 

e AGRA . The gyro words were corrected for their own turnovers. 
At a maximum rate of 200 counts/sec, only 21 bits are actu- 
ally needed. 

a S5T . The X and Y words were sent alternately every 50 msec 
to the 1700 computer. The data transmitted to the magnetic 
tape always included the X word corresponding to the nearest 
time- tag. 

e ABTA . The range of the table movement in SUE required only 
13 of the 21 bits available. 
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e SST . These 2 words were the stored values from the last 
time the RUNNING AVERAGES submode was entered in MODE 2. 

e AAA/C . These two words were computed as: 

AAA/C = AA/Cjj^^jg 3 - AA/C^j^^^g 2 

Where 

AA/C„_j^ 0 = stored values from the last time the 
»noae 6 RUNNING AVERAGES submode was entered 
in MODE 2 


9 " stored valuos from the last time the 
RUNNING AVERAGES submode was entered 
in MODE 1. 

7.2 GIMBAL SYSTEM TEST PROGRAM 

The following sections describe the modes, data displays, and data 
collection capabilities of the gimbal system test program GWEN. 

7.2.1 Program Modes 

There were three main program modes in GWEN. 

MODE 1 - REFERENCE POSITION . This mode positioned the ABF such 
that the SS and AA/C are pointed at the theodolite and reference mirror, 
respectively, and pointed the GST to a nominal angle. The mode was used 

1} To align the SS and reference mirror before the test 

2) To define the AA/C boresight during the test 

3) To measure any misalignment between the SS and the 
reference mirror after the test. 

Servo loops were closed around the ABT and GST using their readouts. 
Constant angles, ABTO and GSTO, were commanded. The difference between 
the readouts anu the command angles were output unsealed as position 
signals to the servo electronics. To hasten acquisition, rate signals 
were commanded whenever the corresponding position signal saturated. 
Expressed in equation form, 

TPOS = ABTO-ABTA, |TPOSl <2047 bits 
TPOS = 2047 sign (TPOS), |TP0S| > 2047 bits 
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GPOS 


= GST0-6STA, |GPOS| <2047 bits 

GPOS = 2047 sign (GPOS), IGPOSj > 2047 bits 
and 

IRATE = 0, j IPOS I < 2047 bits 

IRATE = 2047 sign (IPOS), ITPOS] >2047 bits 

GRATE = 0, I GPOS I < 2047 bits 

GRATE = - sign (GPOS), |GP0Sj > 2047 bits (equivalent to 1*^ sec) 

These equations were updated every 3 msec. 

MODE 2 — ZERO POSITION . This mode positioned the ABT such that the 
SS and AA/C are pointed at the GST via one of the three rotating mirrors 
on the ABT, and moved the GST gimbal to search for and lock on to the 
star. The mode was used immediately prior to each star transit to measure 

1) Small rotations of the GST with respect to the AA/C bores ight 
which may occur during the test 

2) Drifts in the GST static pointing angle during the test. 

The same servo loops were closed about the ABT and, during search, 
about the GST as in MODE 1. When the star was acquired (track), upon 
command of the computer, the hardware switched to a second servo loop 
which drove the gimbal to null the OSU vertical deflection signal. 

For the computer-closed loops, the same equations as in MODE 1 ap- 
plied except that ABTO and GSTO were a function of the 3 star positions 
which were selected manually from two switches on the DTU. The servos 
were updated every 3 msec. 

MODE 3 - STAR TRANSIT . This mode drove the ABT in a ramp at earth 
rate to sweep a simulated star across the field of view strip of the GST. 
The ramp described in Figure 7-2 was commanded to the ABT servo loop which 
was identical to the loops in MODES 1 and 2. The GST gimbal was driven 
in the same way as in MODE 2 to search and track the star. Exit from 
MODE 3 terminated the ABT ramp and also the GST search if a star had not 
been acquired. As in MODES 1 and 2 both servos were updated every 3 msec. 
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Figure 7-2. Ramp Function for the Gimbal Test 
There were two submodes in GWEN: 

RUNNING AVERAGES . This submade, when exercised, and depending on 
the main program mode, computed running averages of both AA/C axes, the 
gimbal readout, the GST x and y deflections, and the differences between 
the star tracker x deflection and table angle. The last computed running 
average for all but the latter signal, was stored for transmittal to mag- 
netic tape upon exit from the submode. The running averages were each 
computed by the equation: 

Vl = (1 - e) 7^ + e 

where 

X = running average 
y = observation 
e = weighting factor 

The details for each running average including scaling, update interval 
and weighting constant are given in Table 7-8. 

DATA COLLECTION . The remarks for the submode in SUE apply. 



7.2.2 Mode Control 


The teletypewriter was used only to start and stop the program. All 
other control was from six manual switches on the DTU. The switch logic 
for mode control is shown in Table 7-5. The logic for star selection is 
shown in Table 7-6. Switch No. 3 controlled the RUNNING AVERAGES submode, 
and switch No. 4 the DATA COLLECTION submode. For all switches "up" cor- 
responded to a "one" state which in turn corresponded to the affirmative 
state of the switch function name. 


Table 7-5. GWEN Mode Control Logic 


Mode 

Description 

Swi tch 

No. 1 
Bit 0 

No. 2 
Bit 1* 

1 

REF POS 

0 

0 

2 

ZERO POS 

0 

1 

3 

STAR TRANSIT 

1 

1 


Slow input channel, status word bits 


Table 7-6. GWEN Star Selection Logic 


Star 

n Value 

Switch 

No. 5* 
Bit 10 

No. G* 
Bit 9 

1 

1 

0 

1 

2 

2 

1 

0 

3 

3 

1 

1 


Slow input channel, status word bits 
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7.2.3 Program Discrete Commands 

The program sets the bits of the slow output channel, bilevel command 
word to the states indicated in Table 7-7. Bit 0, SEA TRACK/SEARCH com- 
manded the GST to switch from the gimbal servo loop implemented about the 
gimbal readout and the computer to the loop using the star tracker vertical 
output signal. The former loop used the computer to supply a nominal star 
position and a summing junction; the latter was implemented entirely in the 
GST electronics. Since it was desired to switch to the tracker loop as 
soon as a star is acquired, bit 0 was made identical to bit 4 of the slow 
input channel status word, GST TRACK/SEARCH. 


Table 7-7. GWEN Discrete Commands 


Slow Output Channel Command Word 

Mode 

Bit 

Description 

1 

2 

3 

0 

SEA TRACK/SEARCH 

0 

0,1 

0,1 

1 

SEA MOTOR INHIBIT 

0 

0 

0 

2 

GST SEARCH 

0 

0 

0 

3 

GST BOS INHIBIT 

0 

0 

0 

4 

SST SEARCH 

0 

0 

0 

5 

ABT INTEGRATOR INHIBIT 

0 

0 

0 

6 

ABT MOTOR INHIBIT 

0 

0 

0 

7 

SPARE 

0 

0 

0 

4 





15 

SPARE 

0 

0 

0 


7.2.4 Real Time Diagnostic Data 

Key signals were sent to the 8 channel stripchart recorder via the 
CDC 1700 DACs for display during the test. In addition the memory "peek," 
a LED display on the UTU of selected words in the 1700 memory, 
was used to display the running average of the gimbal readout angle. The 
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signals displayed are described in Table 7-8. The description of the DATA 
REAL TIME DISPLAY for SUE in the previous section applies to GWEN except 
for the weighting constants, e, and the equation for ERROR which, for GWEN, 
was: 

ERROR = - (0.618) (ABTA-ABTO) 

where GSTX is the GST x deflection in millivolts and (ABTA-ABTO) is the 
difference between the ABT angle and its nominal angle for each star in 
counts. 


Table 7-8. GWEN Real Time Display 



DAC 

Channel 


Scaling 

. - 

Output 

Display 

Maximum 

! 





Update 

Running j 


r:oae 


Interval 

Input 

Signal 

Output 

Display 

Average e | 


1 

2 

r— • — 1 

3 


. .. . , J 

\GRAX 

4 

4 

4 

100 sec 

Di rect 

O.IV/cnt 

20,000 cnts 

! 

.•.GRAY 

5 

5 

5 

100 sec 

Direct 

O.lV/cnt 

20,000 cnts 


•■GRAZ 

6 

6 

6 

TOO sec 

Direct 

O.IV/cnt 

20,000 cnts 

1 

gsTx 


7 


50 msec 

6*7 mV/ sec 

0.25V/s?c 

40 sec 

; 0.0125 j 

GSTY 


8 


50 msec 

6.7 mV/s^ 

0.25V/sTc 

40 s^c 

0.0125 ; 

1 AA?^ 

9 

9 


1 sec 

0.15V/sec 

0.25V/sec 

40 s^ 

: 0.05 ! 

1 

AA/CY 

10 

lio 


1 sec 

0.15V/sec 

0.25V/^ 

40 s^c 

. 0.05 ; 

eTO' 



11 . 

50 msec 

(see text) 

0.25V/s"ec 

200 ^ 

0.i>5 1 

! gTta 

1 

j 

on DTU 

50 msec 

digital 

display 

full 

0.05 j 

1 


7.2,5 Data Collection 

Collection of data on magnetic tape in the V73 computer was initiated 
and terminated by switch No. 4 on the DTU panel. There were three data 
formats : 


1 ) Non- track 

2) Start of track 

3) Tr?"k, 
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Three conditions were necessary for the track state: 1) MODE 3; 2) a 

track signal from the GST (SI channel STATUS word, bit 4); and 3) a posi- 
tive ramp be present. During the nontrack state three time- tagged gyro 
signals were stored on tape every one second: 

GRAX = X gyro angle, arc seconds 

GRAY = y gyro angle, arc seconds 

GRAZ = z gyro angle, arc seconds. 

At the start of track, running averages calculated and stored during MODE 1 
and MODE 2 were stored on tape: 

GSTA = Last average gimbal angle calculated in MODE 2 before 
switch No. 3 was turned off, arc seconds 

GSTX = Last average star tracker horizontal angle calculated 
in MODE 2 before switch No. 3 was turned off, arc 
seconds 

GSTY = (Same as GSTX, but for vertical angle) 

AAA/CX = Last average AA/C horizontal angle calculated in MODE 2 
before switch No. 3 was turned off minus the last average 
AA/C horizontal angle calculated in MODE 1 before switch 
No. 3 was turned off, arc seconds 

AAA/CY = (Same as AA/C^X, but for vertical angle). 

During track, time tagged information from the gyros, the GST, and 
the ABT were stored every one second: 

GRAX = (see above) 

GRAY = (see above) 

GRAZ = (see above) 

GSTA = Gimbal angle, arc second 

GSTX = Star tracker horizontal angle, arc seconds 

GSTY = Star tracker vertical angle, arc seconds 

ABTA = ABT angle with zero corresponding to the GST horizontal 
boresight position, arc seconds. 

Time tags were accurate to 1 msec. Scaling for the signals corresponded 
to Table 7-8. Angles in arc seconds were given to one significant place- 


8. PADS PERFORMANCE EVALUATION PROGRAMS 


The performance evaluation of the PADS test data was performed offline 
on a CDC 6500 digital computer via a timeshare teminal. The offline com- 
puter programs were coded in FORTRAN. Their input consisted of the mag- 
netic tape data from the V73 computer and certain initialization and con- 
trol parameters which were inserted from the timeshare terminal. Their 
output consisted of the three-axis attitude errors in the PADS estimate 
of its inertial attitude plus other data which facilitated interpretation 
cf the attitude errors. Two offline programs were used: one for the 

strapdown tests, and one for the gimbal tests. 

A functional block diagram applicable to either computer program is 
shown in Figure 8-1. The program is divided into two main sections: 1) 

the PADS algorithms, and 2) the laboratory algorithms. In the ground- 
fixed test configuration the PADS axes are identical to the laboratory 
axes, and are physically defined by the optical cube on the strapdown star 
tracker, or the three reference mirrors on the gimbal star tracker. The 
PADS algorithms estimate the attitude of the PADS axes relative to their 
inertial attitude at the start of the test run. In a four hour test, for 
example, the PADS axes will rotate 60° due to the rotation of the earth. 

The orthogonal transfomation matrix A will reflect the PADS estimation of 
the rotation given continuous gyro information and periodic star tracker 
transits. The laboratory algorithms compute the true inertial attitude 
of the laboratory, expressed by the matrix A, using the precisely known 
value of earth rate. The agreement between these two matrices is a direct 
measure of the PADS performance. 

The PADS algorithms are identical to those described in Section 3.2 
with the exception of the star catalog information. In the laboratory 
test the star catalog information is formed by the laboratory algorithms. 
These algorithms compute the orientation of the collimated star beams 
relative to the true laboratory or PADS axes. 

In addition to the two main sections the computer programs also con- 
tain data formatting and attitude error generation algorithms. The latter 

determine the small angle three-axis attitude errors from the nondiagonal 

T 

elements of the matrix product A A . 


PADS ALGORtTHlWS 
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DATA 


EARTH 

RATE 



ATTITUDE 

ERROR 


Figure 8-1. PADS Offline Data Evaluation Program 
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The derivation of the fundamental equations for the offline computer 
programs is given in Reference 7. Specific comments regarding the appli- 
cation of these equations to the PADS strapdown and gimbal system tests 
are given in the following sections. 

8.1 STRAPDOWN SYSTEM DESCRIPTION 

8.1.1 True Laboratory Attitude 

The laboratory configuration of the PADS subsystem is illustrated in 

Figure 8-2. The SST optical cube defines both the PADS and the laboratory 

axes. The orientation of this optical cube can be described by a right- 

handed, orthogonal coordinate set (x.j> Xg, Xg) in which each axis is normal 

to a cube face as in Figure 8-2. To definitize this coordinate set '’s 

taken to point opposite the gravity vector, and is selected such that 

it experiences no component of the earth's angular velocity, w , i.e., 

0 

(jjg • x.| = 0. The optical cube with its above defined coordinate set is 

thus taken to be the laboratory reference, and the term "laboratory atti- 
tude" will be taken to mean the orientation of the axes (x-j, Xg, x^) rela- 
tive to an inertial set (z^, Zg, z^). This latter set of axes will be 
taken to be identical to axes (x-j, Xg, x^) at the start of any particular 
subsystem test run. The laboratory attitude at any subsequent run time is 
then given by 




^1 

"2 


"2 

_^ 3 _ 


1 

CO 

N 

J 


( 8 - 1 ) 


where 


\z(^) = 


1 -6(X2^ + aXj + 8 X^X2 ^ ^1^3 

-aX^ + 8 A-,X2 1 -3(A.|^ + X^) aA.j + 6 AgAg 

aAg + 6 A^jAg -aA^ + 8 AgAg 1 -8(A^^ + Ag^) 


“e * ^i 

A. = — i = 1, 2, 3 

1 


( 8 - 2 ) 

(8-3) 
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Figure 8-2. PADS Laboratory Setup 



a = sin w^t ; 
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6 = 1-cos Wgt 
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The A.J depend, of course, upon the orientation of the laboratory relative 
to the earth rate, w . This is largely a function of its latitude, taken 
to be 33.90323 deg north. It should be mentioned that inaccuracies in 
this figure (or in the alignment of the optical cube), while influencing 
the true knowledge of A (t) will have no bearing upon the subsystem per- 
formance measure, as the estimated laboratory attitude provided by PADS 
will contain exactly the same effect. This will be discussed more fully 
in Section 8.1.2. 

8.1.2 PADS Estimate of the Laboratory Attitude 

The PADS subsystem must estimate the laboratory attitude without be- 
ing privy to latitude and a priori earth rate information. The SST/optical 
cube alignment is such that the tracker's boresight lies along ^ 2 , with its 
azimuth and elevation outputs occurring, respectively, about and x.j. 

Now the actual orientation of (x^ , X 2 > x^) relative to (z^ , z^) is 

unknown to the PADS subsystem, as this information can only be established 
through knowledge of w , latitude, and run time, t. Thus PADS can only 

G /N 

provide estimates of the x^- , say x^. , by effective use of the SST and IRU. 
The PADS output is then an estimated laboratory attitude matrix, A (t), 
defined by 
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Combining Equations (8-1) and (8-6) 
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^ -1 

The degree to which A A matches the identity matrix is a direct measure 

xz xz 

of the effectiveness of the PADS subsystem as an attitude estimator. 

To be effective as a three-axis attitude estimator, the SST must be 
sensitive to attitude motions about each of its three axes. A single PADS 
tracker fails in this respect due to its extremely small field-of-view. 
and thus a compl ete PADS subsystem must employ two such trackers, with 
optical boresights separated by more than 30 deg or so. Since the labora- 
tory test involved only a single tracker, the system prediction of attitude 
about the Xg axis will be ignored, and performance measured solely upon its 
success in pointing the Xg axis. In essence, the system will thus be 
treated as a two-axis estimator. 

This two-axis estimator employs a three-axis gyro package, whose gyro 
input axes (x, y, z) are illustrated by Figure 8-2 and satisfy 


(8-8) 

Unfortunately, the gyro whose input axis is z (or x^) is much poorer in 
performance than the other two, and thus causes very pessimistic predic- 
tions of laboratory attitude about the x^ axis. In fact, such results 
can be termed Worst Case. Best Case results would be obtained if the z 
gyro were aligned, instead, along the X 2 axis, whose attitude is not 
effectively estimated anyway. Thus two types of performance results will 
be presented in Section 9. Worst case results will deal with the actual 
laboratory gyro configuration given by Equation (8-8), and best case re- 
sults will simply transform the actual gyro outputs to the values that 
they would have experienced had the z gyro been aligned along X 2 . The 
only assumption made in this process is that the gyro errors are invari- 
ent to rotation, an assumption that is not really germane to the evalua- 
tion of the PADS. 

8.1.3 The Star Catalog 

The PADS estimation algorithm has been previously described in Sec- 
tion 3.2. Key to its operation is its usage of fixed star locations as 
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attitude benchmarks in an inertial reference frame. In analogy, the 
location of comparable stars in the inertial set (z.|, Zg, z^) must be 
established. This effectively then becomes the estimator's star catalog. 

Figure 8-2 illustrates the means whereby a star line of sight is 
formed using the star simulator and air bearing table mirror. A fixed 
separate light source for each of three stars is housed in the star simu- 
lator. The light emanating from '■he j such source is defined by 


= I “S1 


( 8 - 9 ) 


where the u^^. are time invariant. The table mirror normal, on the other 
hand is defined by 


n = sin 0(t) X.J + cos 9(t) Xg 
The input star line-of-sight to the SST is then given by 

u-^ = E X. - Ug’^ - 2 n (n • Ug-^*) 


( 8 - 10 ) 


( 8 - 11 ) 


The inertial coordinates of this star at time t, namely the benchmark 
attitude reference used by PADS, are then given by the three direction 
cosines 


a^*^ = u'^' • z^. i = 1, 2, 3 

where clearly 


a.J 
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The method whereby PADS causes to converge toward A is then basically 

xz xz 

dependent upon adjusting the attitude estimate until its estimate of the 
u^"^, say u-*^, coincides with the u^-'^ as obtained by measurement. Clearly 
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As mentioned before, errors in providing exact truth model earth 

rate or latitude data will influence A^^^’ performance 

measure A A~^. This is because the same error effect will, appear in 

S due to the fact that the inertial star direction cosines, a. , are 

* 

directly influenced by A through Equation (8-13). Likewise, the ap- 
parent drift rates of the three gyros will shift slightly should inexact 
values of or latitude be used. A similar comment can be made should 
the gyros not precisely satisfy the transformation of Equation ( 8 - 8 ). 

In neither event is the performance measure of PADS degraded. 

8.2 GIMBAL SYSTEM TEST 

In parallel to the system test employing a body fixed tracker, the 
purpose of the gimbaled system test is to establish the performance of 
the gimbaled star tracker (SST) and the gyro assembly when combined with 
a suitable data reduction algorithm as an attitude estimation subsystem. 
This subsystem will be used to estimate the attitude of the laboratory 
relative to an inertial set of coordinates. As before, the true attitude 
of this earth-fixed laboratory is essentially known as a function of time, 
providing a direct means of evaluating system performance. 

8.2.1 True Laboratory Attitude 

The laboratory configuration of the PADS subsystem is illustrated in 
Figure 8-3. The laboratory fixed axes are defined as in Section 8.1; a 
right-handed, orthogonal, coordinate set for which Xg is taken to point 
opposite the gravity vector, and x.j is selected such that it experiences 
no component of the earth's angular velocity, Wg, i.e., • x^. = 0. The 

term "laboratory attitude" will be taken to rean the orientation of the 
axes (x^ , x^) relative to an inertial set (z.| , Z 2 , Z 3 ). This latter 

set of axes will be taken to be identical to axes (x-| , X 2 , x^) at the 
start of any particular subsystem test run. The laboratory attitude at 
any subsequent time is then given by Equations (8-1) to (8-5). 
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Figure 8-3. Gimballed PADS Laboratory Setup 





8.2.2 Glmbal PADS Estimate of the Laboratory Attitude 


The PADS subsystem must estimate the laboratory attitude without 
being privy to latitude and a priori earth rate information. 

Consequently, the actual orientation of (x^ Xg* x^) relative to 
(z-j, Zg# z^) cannot be established by the PADS subsystem, as this infor- 
mation can only be obtained through knowledge of Ug, latitude, and time, 
t. Thus PADS can only provide estimates of the x^, say x. , by effective 
use of the GST and IRL) data. The PADS output is then an estimated labora- 
tory attitude matrix, A (t), defined by Equation (8-6), with Equation 
(8-7) again providing a measure of the system's effectiveness. 

Unlike the body fixed tracker, the gimbal star tracker provides at- 
titude estimates about all three axes (rather than two axes). However, 
since the gimbal motion between the two outer laboratory "stars" is only 
about 38 deg, the anticipated accuracy about the x-j axis is less than 
that about either x^ or x^. Thus the results v/ill be presented in two 
ways: as a full three-axis estimator, and as a two-axis estimator which 

ignores errors about x^. This latter figure of merit will provide a more 
direct comparison to the results obtained for the body fixed tracker. 

Also, since three-axis estimates are the primary goal of this test, there 
is no great advantage in any particular alignment of the IRU. Thus, the 
actual laboratory orientation of this unit given by Equation (8-8) will be 
assumed throughout the test runs. 

8.2.3 The Star Catalog 

The gimbal PADS estimation algorithm has been previously described 
in Section 3.2. Key to its operation is its usage of fixed star loca- 
tions as attitude benchmarks in an inertial reference frame. In analogy, 
the location of comparable stars in the inertial set Zg, z^) must be 
established. This effectively then becomes the estimator's star catalog. 


Figure 8-4 illustrates the means whereby a star line of sight is 
formed using the star simulator and air bearing table mirror. A single 
fixed light source emanates from the star simulator and is deflected 
downward along -x^ by a fixed mirror mounted above the air bearing table. 
A tilted mirror mounted to the table top then deflects this light beam 

(when the table top is in position) toward the tracker. By utilizing 
the table mirrors, three such stars of differing elevation angles can 
be simulated. This establishes the direction cosines (in lab axes) of 
each star, and its equivalent inertial coordinates are then given, as 
before, by Equations (8-12) and (8-13). Likewise, estimates of the star 
direction cosines (in estimated lab axes) are given by Equation (8-14), 
and the comments following this equation apply here as well. 


FIXED MIRROR 



LIGHT BEAM FROM 
STAR SIMULATOR 
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9. STRAPDOWN SYSTEM TEST 


This section describes the strapdown system test which was run from 
1 October 1975 to 10 October 1975. The orbit scenario on which the test 
was based is described along with comments regarding initial alignment of 
the PADS axes. All of the four test runs which were conducted during the 
ten day test period are analyzed using several performance measures. Two 
of the test runs were selected for detailed analysis to illustrate the effect 
of individual error sources on the PADS attitude estimates. A parametric 
analysis is made to evaluate the effect of star update interval on the PADS 
accuracy. Lastly, a summary of the PADS accuracy is presented. 

9.1 TEST DESCRIPTION 

The spacecraft configuration postulated for the PADS system test is 
that of a three-axis stabilized , earth-pointed satellite in geosynchronous 
orbit. An experiment on board, a telescope, for example, requires precise 
information regarding the inertial attitude of its sensitive axis or axes. 

The PADS is used to provide this information. 

A calibration of the PADS star tracker boresight axis relative to the 
experiment axes is allowed once every ten days. Following a calibration 
the experiment may require the PADS attitude information for any length of 
time, for any number of times, during the next ten days. 

By way of configuring a practical laboratory test, four test runs, 
nearly evenly spaced in time, were conducted during a ten day test period. 
Each run was four hours in duration. During each run a star update was made 
every 20 minutes. This corresponded to a star being available every 5° in 
right ascension. Three different star declinations were used. All stars 
were 8 GO (6000°K). 

The test period was limited to ten days by the scope of the PADS con- 
tract and not by any limitation in the stability of the star tracker. Four 
runs during the ten day period were adequate to measure the day-to-day 
stability of the tracker, while a four hour run was sufficient to ensure 
steady-state behavior for star updates up to 60 minutes apart. The minimum 
star update time of 20 minutes was determined by the gyro performance (see 
Section 4.1). Three star declinations were considered adequate to exercise 
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the tracker field of view linearity accuracy. Making all stars 8 
presented a worst case situation in terms of tracker noise and simplified 
test equipment design. 

9.2 INITIAL ALIGNMENT/CALIBRATION 

The PADS reference axes were defined physically by the optical cube on 
the strapdown star tracker. The PADS experienced a fixed input rate, i.e., 
earth rate, during a test run. Consequently, no effort was made to pre- 
cisely determine the gyro input axes orientations relative to- the cube since 
an axis misalignment would be indistinguishable from a fixed drift rate 
error. 

The original intent was to align the tracker electro-optical boresight 
to the normal to the front face of the optical cube, and to adjust the field 
of view alignment about the boresight so that a zero vertical output resulted 
for a star on the negative x axis at the edge of the field of view. The 
field of view nonlinearities were to be calibrated from a component test 
performed in a separate facility from that of the system test. 

Unfortunately, the calibration data from the star tracker component test 
contained unacceptable errors which were not recognized at the time the 
data was collected. These errors are described in Volume I, Section 7. As 
a result it vi/as necessary to recalibrate the field of view using the three 
stars in the system test configuration. This recalibration took place 
immediately prior to the ten day system test. The overall result was the 
invalidation of the independent measure of the accuracy of the field of view 
linearity. The recalibration did not affect the basis for the alignment, 
albeit indirect, of the boresight to the optical cube, namely, the ground- 
rule that the boresight would be calibrated relative to the experiment axes 
every ten days. 

9.3 SYSTEM TEST RESULTS 

The following system test results were obtained using the computer 
performance evaluation programs described in Section 8. 


9.3.1 Pass Parameters 


Four test runs, each of approximately four hours in duration, were 
conducted between 1 October 1975 and 10 October 1975. This time tagged 
sensor data was then utilized by the Estimation Algorithm to predict both 
laboratory attitude and the gyro drift rates. Aside from the time tagged 
sensor data, the algorithm requires a number of additional inputs dealing 
primarily with statistical quantities that describe initial uncertainties 
in both attitude and gyro drift rates, as well as uncertainties in both 
gyro and star tracker noise parameters. In general, the attitude estimation 
performance of the Estimation Algorithm is dependent upon the values of 
assumed noise. Also of significance is the degree of filtering applied to 
the output of the tracker, as longer time constants tend to reduce the 
impact of tracker noise. Taking such parameter variations into account, a 
total of 31 attitude estimation computer passes were made based upon the 
four test runs previously mentioned. Table 9-1 lists the conditions for 
these 31 passes. 

9.3.2 Performance Measures 

The effectiveness of the Attitude Estimator is based primarily upon 
three things: 

1) The degree to which the estimator accurately predicts the 
attitude of the ^2 axis. If e.| and represent the estimation 
errors about, respectively, the x-j and x^ axis, then the 
boresight (Xg) attitude error is given by 

e = + (9-1) 

2) The degree to which the boresight attitude error, which of 
course is unknown operationally, is reflected by the estimator's 
error covariance prediction. Observation of the latter should 
give a strong indication of the actual errors. Comparing the 
attitude error covariance prediction with the SST measurement 
residuals v^fill check estimator "consistency." 

3) The speed with which the attitude estimates converge from 
sizeable initial estimation errors (e.g., 100 sec) to errors 
that are close to "steady state." 
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Table 9-1. Conditions and Parameters of Computer Passes 


Pass Conditions 

Run Duration - 14800 sec 

star Update Interval - 20 min/40 min/60 min 

Each star utilized 3 times at 55 sec intervals 

if 

Gyro Orientation - Best Case/Worst Case 
Initial Conditions 

Initial Attitude Estimate - 100 ^c error about and 

Initial Attitude Uncertainty (la) 100 sec about x^ arcd x^; 10 sec 
about x^ 

Initial gyro drift rate uncertainty - .02 sic/sec 
Sensor Parameters 


Gyro: 


Estimated Drift Rates. Gyro x -.833 sec/sec 

y -.478 sec/sec 
z -1.055 ^c/sec 

Gyro noise a - .02 to .08 sec/(sec)^^^ 

V * 

Gyro noise - .2 x lO”^ to .6 x 10”^ sec/(s'^)^^^ 

Gyro noise a - 0.1 sec 
0 


star Tracker: 


Calibration coefficients as specified in Volume I, Section 7 

Time constant (both axes) - .0466 sec 

Digital output filter (both axes) - 0 to 3 sec* 

Output noise (both axes) - 1.5 to 3 sec* 


Specified in Test Run 
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Items 1) and 2) are time variant and require additional qualification if 
clear figures of merit are to be adopted. Figure 9-1 illustrates a typical 
sequence of 6 values, a value being plotted every 300 sec and also at times 
just prior and just subsequent to an attitude update. 

For the merit figures, the discrete points are connected by straight 
lines. The mean pointing error and its standard deviation are then com- 
puted as 


“e 'It 


2 ^^i+1 ®i^ ^^i+1 ■ 


N n" 
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+1 


S-) 
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(9-3) 


where 


0^. = 0 (t. +) 
0^. = 0 {t. -) 


(9-4) 

(9-5) 


with t|^ and t^ representing, respectively, the final time and time at which 
the effect of initial estimates have disappeared. A similar appraoch is 
also used in computing the mean and standard deviation, ug and og, of the 
attitude estimator's guess (based upon its covariance matrix) as to the 
reliability of its output. Lastly, p and a have similar interpretations 

J V 

regarding the measurement residual. The six merit figures will be used 
extensively in what follows. 

9.3.3 Detailed Analyses of Passes No. 8 and No. 9 

Pass No. 8 met the general conditions of Table 9-1 under the additional 
specifications: 

Tracker noise (la) - 1.5 s'ec 

Tracker output filter time constant - 3 sec 

Tracker update interval - 20 min 

Gyro noise a - .04 sec/sec ' in x and y; .08 in z 

V A oyo 

- .6 x 10 sec/sec * in x, y, and z 
Gyro Orientation - Best Case 
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Figure 9-1 illustrates the convergence of the estimation error, 0, of 
the boresight (x^) attitude, A dramatic correction in attitude estimation 
error is made after just one star sighting. However, the gyro drift rates 
retain sufficient error to cause considerable divergence until the second 
star sighting at about 2600 sec. The drift rates are then also corrected 
and fairly benign performance {which we shall call "steady state") occurs 
thereafter. Figure 9-2 illustrates, on a larger scale, the estimation error 
from about 5000 sec onward. An average pointing error of about 2 s'ec is 
experienced, which corresponds to a 1.4 sec error per axis. 


fatME h VpxD'ft i | ! | ^ | 
Figure 9-2. Pass No. 8 Expanded 








When the conditions of Pass No. 8 are altered by assuming a worst case 

rather than best case gyro orientation, the convergence of 0 remains about 

the same. Steady state behavior is considerably degraded, however, as 

Pass No. 9 in Figure 9-3 clearly shows. In this case an average pointing 

error of about 3.2 sic is evident, corresponding to 2.3 sic per axis. This 

is clearly a result of the z gyro drift rate fluctuation, which now directly 

influences the pointing estimate. If represents a gyro's rate output, 

then Figure 9-4 presents the rate variation “g(t) "for each of the three 

gyros over the run duration Eo,T] where T = 14800 sec. w' (t)' is of the form 

y 

Wg(t) = Mg{t) - aig(t) (9-6) 

where 

w (t) is the average drift rate for the run duration, 
y 



I 
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It is clear that the z gyro experiences severe drift rate changes at both 
6100 sec and 12730 sec. This is consistent with the results of Figure 9-3, 
which shows the start of a severe fluctuation in the attitude estimate at 
about these times. 

9.3.4 PADS Steady State Parametric Test Results 


The results for all four test runs are shown in Figure 9-5, in terms 

of the previously defined performance criteria Pq, a„, pg, as, p„, In 

0 0 u H y y 

general, the system results are excellent, with the following conclusions 
evident 


9 All of ^e 13 passes indicate an RMS pointing error, Oq, of better 
^n 4 ^c. In fact, the average Og over the 13 passes is 3.08 
s'ec for a per axis error of 2.2 sec. 

9 The performance of the best gyrc^rientation exceeds that for the 
worst orientation by 0.4 - 1,0 sec. 

© Filtering the tracker output through a 3 sec time constant filter 
shows significant improvement over a 1 sec filter. 



1 
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9 Gyro data base B results in filter covariance estimates that 
agree more closely than A with actual performance. 

e Passes 5, 6, 8, 17, 23, and 18 show excellent agreement between 
actual performance, filter predicted performance, and the actual 
measurement residuals. 

8 Passes 1, 7, 28, and 16 indicate poorer agreement. In Passes 1 
and 7 too high a value of tracker noise was assumed. Pass 28 is 
plagued by tracker bias, which was independently established. 
Pass 16 is also somewhat plagued by such bias, but in addition 
is optimistic in its assessment of gyro noise. 

Plgurir PADS Ten RMUlts - 20 fMn, Updates 



i 
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Figure 9-11 presents results similar to Figure 9-5, but for systems 
with less frequent star updates. In each case rapid initial convergence was 
obtained as the first two star updates were taken 20 min apart. Thereafter, 
the update interval was as noted, either 40 or 60 minutes. As anticipated, 
these results are somewhat poorer. Specifically; 

0 The peak 40 mii^RMS error, ae, is 7 sTc, with the average oq 

given by 4.32 sec, or 3.06 s'!?:, per axis. 

6 The peak 60 min RMS error, <^is 13 s'ec, with the average 00 

given by 7.72 s'?!:, or 5,46 per axis. 

0 The influence of worst case over best case gyro alignment is now 
much more severe, as much longer time intervals exist between 
gyro bias corrections. 

0 Test runs 1 and 4 indicate much better results than either 2 
or 3, Test run 2 is particularly poor due to the aforementioned 
tracker bias. 

0 Passes 11, 13, 25, 26, 14, and 15 show fairly good agreement 
between actual and filter predicted performance. 

» Passes 10, 30, and 31 show quite a difference between actual and 
predicted results. The latter two are influenced by the unobserv- 
able tracker bias, whereas Pass 10 uses gyro noise parameters 
which are pessimistic for these longer filtering durations. In 
practice, when the update intervals vary, the gyro noise param- 
eters must assume some compromise values. 

Figures 9-12 to 9-15 illustrate typical steady state behavior patterns 
for these increased update duration runs. 
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9.3.5 PADS Accuracy 

. The criteria for the accuracy of the PADS is the RMS of the difference 
between the PADS estimate of the inertial attitude of its reference axes 
and the true attitude of these axes as indicated by: 


1 ) Laboratory i nstrumentati on 

2) A priori knowledge of earth rate and the inertial attitude 
of the laboratory at the start of a test run. 

This criteria is designated Og in Figures 9-5 and 9-11. 

The parameters selected for the nominal PADS algorithm for the 20 
minute updates are: 


1 ) 

2 ) 

3) 


Filter time constant: 3 sec 

1/2 

Gyro noise (x and y gyros): a,, = 0.04 arc sec/sec 

'' -4 3/2 

CTy = 0.6 X 10 arc sec/sec ' 

SST noise: 1.5 arc sec. 


The parameters for the 40 and 60 minute updates were the same except for 
the gyro noise sigmas which were reduced by 1/2 and 1/3 for and o^, 
respectively. The passes representative of the values in Figure 9-5 are 
numbers 8, 28, 17, and 23, or test runs 1, 2, 3, and 4, respectively. In 
Figure 9-11 the 40 minute update representative passes are numbers 11, 30, 
20, and 25, or test runs 1, 2, 3, and 4, respectively. The 60 minute 
update representative passes are numbers 14, 31, 22, and 27, or test runs 
1, 2, 3, and 4, respectively. 

Table 9-2 summarizes the value of for the nominal PADS algorithm 
with the best gyro orientation. Values from all four test runs are avail- 
able for each update interval. The rms of the values for the four runs is 
the PADS two-axis error for a given update interval. This rms, divided by 
</Z, is the PADS single-axis error. 

The PADS design goal is 3.6 arc seconds (la) per axis for 20 minute 
star updates. The measured error of 2.3 arc seconds is well within the 
design goal. 
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Table 9-2. PADS RMS Error 


Test Run 

20 Minute 
Updates 

40 Minute 
Updates 

60 Minute 
Updates 

1 

2.0 

2.3 

3.3 

2 

4.0 

7.1 

13.5 

3 

3.7 

5.7 

8.3 

4 

2.7 

3.6 

•5.8 

rms (2- axis) 

3.2 

5.0 

8.6 

rms (1-axis) 

2.3 arc sec 

3.6 arc sec 

6.1 arc sec 


The increase in measured error with increased update interval is also 
indicated in Table 9-2. Although the incv’ease appears well behaved, exam- 
ination of the individual test runs reveals a large variation in values, 
indicating caution should be applied in generalizing these results. 











10. GIMBAL SYSTEM TEST 


This section describes the gimbal system test which was run from 
6 February 1976 to 16 February 1976. The orbit scenario on which the test 
was based is described along with comments regarding initial alignment of 
the PADS axes. All of the four test runs which were conducted during the 
ten day test period are analyzed using several performance measures. Two 
of the test runs were selected for detailed analysis to illustrate the effect 
of individual error sources on the PADS attitude estimates. A parametric 
analysis is made to evaluate the effect of star update interval on the PADS 
accuracy. Lastly, a summary of the PADS accuracy is presented. 

10.1 TEST DESCRIPTION 

The spacecraft configuration postulated for the PADS system test is 
that of a three-axis stabilized, earth-pointed satellite in geosynchronous 
orbit. An experiment on board, a telescope, for example, requires precise 
information regarding the inertial attitude of its sensitive axis or axes. 

The PADS is used to provide this information. 

A calibration of the PADS gimbal star tracker axes relative to the 
experiment axes is allowed once every ten days. Following a calibration 
the experiment may require the PADS attitude information for any length of 
time, for any number of times, during the next ten days. 

By way of configuring a pr 2 f'^•ical laboratory test, four test runs, 
nearly evenly spaced in time, were conducted during a ten day test period. 

The first three runs were four hours in duration, the last was five hours. 
During each run a star update was made every 20 minutes. This corresponded 
to a star being available every 5° in right ascension. Three different 
star declinations over approximately a 40° span were used. All stars were 
3.5 My GO (6000°K). 

The test period was limited to ten days by the scope of the PADS con- 
tract and not by an assumed limitation in the stability of the star tracker. 
Four runs during the ten day period were adequate to measure the day-to-day 
stability of the tracker. Four hour runs were sufficient to ensure steady- 
state behavior for star updates up to 40 minutes apart. The five hour run 
was made to provide data for star updates 60 minutes apart. The minimum 
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star update time of 20 minutes was determined by the gyro performance (see 
Section 4.1). The maximum star separation in declination of 40° was con- 
sidered adequate to provide three-axis information with the single star 
tracker. Making all stars 3.5 presented a worst case situation in terms 
of tracker noise and simplified test equipment design. 

10.2 INITIAL ALIGNMENT 

Alignment of the gimbal sta>' tracker presented considerably more com- 
plexity than that encountered with the strapdown star tracker. In the case 
of either tracker the objective was to determine the alignment of the 
electro-optical (EO) axes relative to optical surfaces on the tracker base. 
For the strapdown tracker the only critical EO axis was the EO boresight, 
i.e. , that position in the field of view at which a star produced zero 
electronic output in two axes. Using the parallel beam star stimulus 
approach, it was an easy task to align the boresight normal to the front 
face of the optical cube within an arc second. However, the gimbal tracker 
has two EO axis which are critical: 1) the EO boresight zero position, 

defined as that position of a star wherein both optical sensor field of 
view outputs are zero, and the gimbal angle readout is also zero, and 2) the 
normal to that plane for which the angle of incidence between the plane and 
the EO boresight remains constant for all gimbal angles. The second axis 
is the effective gimbal axis, purposely defined in an electro-optical rather 
than a mechanical sense. The obliqueness of the definition is necessary to 
account for a possible nonorthogonality between the EO boresight and the 
effective gimbal axis. Determining the orientation of both these EO axes 
relative to the three mirrors attached to the base of the tracker to within 
one arc second entailed a significant activity. 

The first step undertaken was identification of the effective gimbal 
axis. Ideally this should have been accomplished electro-optical ly, but no 
practical technique was available ,o do this with an arc second accuracy. 
Consequently, recourse was made to an optical-mechanical technique. This 
consisted of mounting a mirror on the end of the gimbal axis with its surface 
normal to the gimbal axis. Normality was observed by autocall imating off 
the mirror with a theodolite and adjusting the mirror orientation until no 
deflection was observed with the theodolite as the gimbal and attached 
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mirror were rotated. Performance of this task led to two observations: 

1) the gimbal axis sagged such that the mirror on the end of the axis tilted 
34 arc seconds from the effective gimbal axis, and 2) the rate of change of 
this sag was 4 arc seconds for a gimbal motion of 30°. Both of these effects 
are shown in Figure 10-1. The sag was determined by leveling the gimbal 
axis using the optical cube on the optical sensor. With the theodolite 
viewing the back face (negative boresight axis) of the cube, the tracker 
base fixture was shimmed until no horizontal deflection was measured as the 
gimbal was turned through 20°. In view of the method used, the accuracy of 
the measured sag is probably no better than 5 arc seconds. On the other 
hand, the relative change of the sag with gimbal angle was measured directly 
with the theodolite, and its accuracy is better than one arc second. 

The gimbal axis sag theoretically should have no significant effect on 
the performance of the star tracker. However, it did invalidate accurate 
determination of the vertical alignment of the effective gimbal axis through 
optical-mechanical techniques. In view of the symmetry of the curve in 
Figure 10-1 about the ordinate, and the mechanical symmetry of the plus 
and minus 30° gimbal positions relative to the gravity vector, it was assumed 
that the horizontal component of the mirror normal was within an arc second 
of the effective gimbal axis. 


VERTICAL DEFLECTION 
OF MIRROR NORMAL IN 
ARC SECONDS 

aHE EFFECTIVE GIMBAL 
AXIS IS AT ZERO! 



Figure 10-1. Gimbal Axis Sag 
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The next step In the alignment procedure was to adjust the EO boresight 
normal to the effective gimbal axis. This was accomplished using two theo- 
dolites as shown in Figure 10-2- The tracker base was turned until the sum 
of the two angles indicated in the figure was 90°. The optical sensor was 
then rotated in the gimbal until zero horizontal output was obtained. Using 
both theodolites in this manner gave an accuracy of one or two arc seconds 
for this step. 

With the EO boresight now aligned normal to the effective gimbal axis, 
the relative orientations of the three reference mirrors v/ere determined 
through the use of the parallel beam star stimulus technique. With the 
tracker in place the stars were adjusted via the rotating mirror assembly 
so that the three star beams were normal to the three tracker reference 
mirrors. Immediately following this the star tracker was removed and the 
theodolite inserted in its place. The theodolite was then used to measure 
the relative orientations of the star beams. The results were previously 
shown in Figure 4-21 and are repeated in Table 10-1. 


GIMBAL STAR 
TRACKER 



Figure 10-2. Alignment of the EO Boresight to the Effective 
Gimbal Axis 



Table 10-1. Relative Reference Mirror Orientations 


Mi rror 

Vertical 

Horizontal 

No. 

(arc sec) 

(arc sec) 

1 

+68380.2 

-3.2 

2 

0.0 

0.0 

3 

-68392.8 

-4.8 


The last alignment step was to determine the orientation of the three 
mirror normals relative to the tracker axes. iMmediately prior to the 
system test, with the tracker in place, the orientation of the tracker axes 
relative to the stars was measured using the tracker outputs, and the orien- 
tation of the stars relative to the mirror normals was measured using the 
parallel beam technique and the automatic autocollimator outputs. Combining 
the two sets of measurements gave the results shown in Table 10-2, The 
numbers in parenthesis are the relative orientations. 


Table 10-2. Reference Mirror Positions in Tracker Axes 


Mirror 

No. 

Vertical 
(arc sec) 

Horizontal 
(arc sec) 

1 

53814.9 ( 68379.9) 

-9.6 (-5.2) 

2 

-14564.8 ( 0.0) 

-4.4 ( 0.0) 

3 

-82958.0 (-68393.2) 

-8.2 (-3.9) 


Comparison between Tables 10-1 and 10-2 leads to two observations. 
First, if the coordinates in Table 10-1 are rotated 4.5 degrees as shown 
in Figure 10-3, then the agreement between the relative horizontal measure- 
ments from the two tables is within 0.5 arc second. This indicates that: 

1) the boresight axis was accurately aligned normal to the effective gimbal 
axis, and 2) the angles between the mirror normals and plane orthogonal 
to the gimbal axis are accurately known. Secondly, the agreement between 
the relative vertical measurements indicates that the gimbal readout, at 
least for the three positions measured, does not have to be calibrated. 
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Figure 10-3. Relative Locations of Mirror Normals 



10.3 SYSTEM TEST RESULTS 

The following system test results were obtained using the computer 
performance evaluation programs described in Section 8 . 

10.3.1 Pass Parameters 


Four test runs, each of approximately four hours in duration, were 
conducted between 6 February 1976 and 16 February 1976. The time-tagged 
sensor data was then utilized by the Estimation Algorithm to predict both 
laboratory attitude and the gyro drift rates. As before, the algorithm 
requires a number of additional inputs dealing primarily with statistical 
quantities that describe initial uncertainties in both attitude and gyro 
drift rates, as well as uncertainties in both gyro and GST noise parameters. 
These parameters are listed in Table 10-3. Varying these parameters, a 
total of 31 attitude estimations passes were made based upon the four test 
runs mentioned above. 

10.3.2 Performance Measures 

The effectiveness of the Attitude Estimator as a three axis device is 
based primarily upon three things: 

1) The degree to which the estimator accurately predicts the attitude 
of the laboratory. If 0 j , 02 , and 03 represent the estimation 
errors about, respectively, the x, , X 2 , and x^ axes, then the 
attitude error is defined by 



2) The degree to which the laboratory attitude error, which of course 
is unknown operationally, is reflected by the estimator's error 
covariance prediction. Observation of the latter should give a 
strong indication of the actual errors. In practice, the operator 
will compare the attitude error covariance prediction with the 

GST measurement residuals in order to check estimator "consistency." 

3) The speed with which the attitude estimates converge from sizeable 
initial estimation errors (e.g., 100 sec), to errors that are close 
to "steady state." 

Items I) and 2) are time variant and require additional quantification if 
clear figures of merit are to be adopted. In this regard, the oer axis mean 
pointing error and its standard deviation are computed as described in Sec- 
tion 9.3.2. 
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Pass Conditions 


Run Duration - 14500 to 18370 sec 

Star Update Interval - 20 rain/40 min/60 min 

Each star utilized once near the azimuth center of the GST field 
of view 

Initial Conditions 

Initial Attitude Estimate - 100 sec error about x-j , Xg, and x^ 
Initial Attitude Uncertainty (la) 100 sec about x^ Xgj and 
Initial gyro drift rate uncertainty - 0.02 sic/sec 
Sensor Parameters 
Gyros : 

Estimated Drift rates. Gyro x --0.840 sec/sec 

y -0.422 s"ec/sec 
z -1.165 ^/sec 

Gyro noise ^ - 0.02 to 0.08 sec/{sec)^^^ ^ 

Gyro noise - 0.2 x 10“^ to 0.6 x 10~^ ^/(sec)^^^ 

Gyro noise ^ - 0.1 s'ec 
Gimbal Tracker: 

Time constant (both axes) - 0.0466 sec 
Digital Output filter (both axes) - 3 sec 
Output noise (both axes) -1.5 s'ec 





10.3.3 Detailed Analyses of Passes No. 11 and No. 21 

Pass No. 11 corresponds to the general conditions of Table 10-3 and 
utilizes the PADS data of 9 February, the gyro being updated every 20 min- 
utes by the gimbaled star tracker. Figures 10-4 and 10-5 show, respectively, 
the corresponding two and three axis convergence of the laboratory attitude 
estimation errors. A total of 12 star updates are employed, in the order 

Star Number: 1 ,3, 3, 3,1 ,3,2,1 ,3,1 ,2,3,3 (A) 

where, noting Figure 8-4, the tracker input star 1 ine-of-sight has a large 
negative projection on for star No. 1, a slight positive projection for 
star No. 2, and a large positive projection for star No. 3. The particular 
sequence noted above was chosen to insure the differing geometric conditions 
inherent in sighting different stars for the more demanding convergence 
conditions associated with 40 and 60 minute updates. Thus when 40 minute 
update passes are made, the star sequence is 

Star Number: 1 ,3,1 ,2, 3, 2, 3 (B) 

and for 60 minute updates passes 

Star Number: 1,3, 2, 1,3 (C) 

The sequence (A) is not optimally beneficial in assuring rapid convergence 
for 20 minute update passes, as star No. 3 is used 3 successive times. This 
is the price paid for better results when the updates are less frequent. 

For Pass No. 11, the first five updates occur at times 329, 1365, 2649, 
3850, and 5044 sec, corresponding to stars 1,3, 3, 3,1 respectively. As the 
results of Figures 10-4 and 10-5 indicate, the first two updates (providing 
4 pieces of independent azimuth-elevation star data) considerably reduce the 
initial error, but are not adequate to establish the six unknowns defined by 
the three attitude and three gyro drift rates. Additional updates by star 
No. 3 at 2649 and 3850 sec provide only slight improvement as the geometric 
conditions are not much different than at 1365 sec. Once star No. 1 is again 
used (at 5044 sec) a dramatic improvement occurs, and the filter can subse- 
quently be considered to be close to its "steady state" operation. The reuse 
of star No. 1 proved geometrically beneficial as its previous use occurred 
sufficiently far in the past. This same convergence pattern appeared in all 
of the 20 minute update passes, regardless of which PADS test run was used. 
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Figure 10-6 shows a comparable three-axis run for the test data of 
6 February. Convergence behavior is essentially the same as described 
above, but there appears a dramatic temporary degradation in the attitude 
estimates at about 8000 sec, long after the filter has supposedly reached 
“steady state." This is caused by a severe shift in the 2 gyro drift rate 
at about the same time, as indicated by the gyro data of Figure 10-7. Of 
significance is the fact that the filter is only temporarily confused by 
this event, providing better and better estimates of the new z gyro drift 
rates as additional star updates appear. 
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Figure 10-7. 02/06/76 Run (200 Sec/Sample) 

10.3.4 PADS Steady State Parametric Test Results 

Tile results for the runs taken on the 9th, 11th, and 16th of February 
are shown in Figure 10-8, for 20 minute updates. The statistics presented 
in each case cover the time interval subsequent to the fifth star update 
to the er.d of the run. The results of the PADS data taken on 6 February are 
not included as the severe jump in the z gyro drift rate provides untypical ly 
pessimistic answers. The following conclusions are evident from Figure 10-8. 

0 Passes 11 and 13 provide two-axis estimates between 3 and 4 sec’ 
and show good agreement to both the corresponding filter 
estimates and the measurement residuals. 

0 Pass 12 indicates poorer results than either 11 or 13. This can 
be traced to anomalous drift rate behavior of both the x and y 
gyros as each gyro's drift rate suddenly shifts by 0.0014 deg/hr 
at one point in the run. The effect is not major, but has 
sufficient impact to negatively influence a short test run of 
only 4 hours. 
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Figure 10-8 Gimbaled 
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Figures 10-9 to 10-12 show typical convergence responses of the 20 
minute update results. 

Figure 10-13 shows results for 40 and 60 minute update intervals. Only 
test run 4 is shown for the latter, as this somewhat lengthened run alone 
allows an adequate number of updates necessary for "steady state" behavior. 
Even at that only the two axis results of Pass 18 have reached what can be 
considered final values. Errors about Xg would have continued to reduce 
had the run time been longer. 
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Figure 10-12. Pass No. 13 " Three Axis 


10-16 

REPRODUCBILirY OP THE 
MGl IS POOR 


■i 














Of the 40 minute update passes. Passes 15 and 17 perforin very well, 
although the three-axis filter confidence has clearly not settled to its 
final value as errors about x-] inherently require more star data. The p 
formance of Pass 15 is somewhat worse, again being plagued by the drift 
rate change of the x and y gyros noted before. Figures 10-14 to 10-17 
illustrate these 40 and 60 minute updating runs. 























10.3.5 PADS Accuracy 


The criteria for the accuracy of the PADS is the mean difference 

between the PADS estimate of the inertial attitude of its reference axes 

and the true attitude of these axes as indicated by the laboratory instru- 
mentation, and a priori knowledge of earth rate and the inertial attitude 
of the laboratory at the start of a test run. This criteria is designated 
Og in Figures 10-8 and 10-13. 

Tables 10-4 and 10-5 summarize the values of a. for. the two-axis and 

a 

three-axis results. As mentioned previously, the first test run contained 
a z gyro malfunction and was not used. Also, only the fourth run was long 
enough to obtain a steady-state result for 60 minute updates. The n-axis 
RMS erro divided by is the PADS single-axis error. 

The PADS design goal is 3.6 arc seconds (lo) per axis for 20 minute 

star updates. The value of 3.6 arc seconds calculated from the two-axis 
results meets this goal, but the corresponding value of 4.8 arc seconds 
from the three-axis results does not. The poorer accuracy from the three- 
axis results is expected since the maximum angle between the three avail- 
able stars was only 38 degree as compared to the optimum of 90 degrees. 

For the purpose of a comparison with the strapdown PADS, which did not 
have such a geometry constraint, the errors from the gimbal two-axis 
results will be used. 

The two tables also show the Increase in measured error with increased 
update interval. The inconsistency between the two-axis and three-axis trends 
is probably due to insufficient data points. The 23.3 arc seconds in 
Table 10-5 is definitely an anomalous point. No generalizations are 
apparent. 
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Table 10-4. PADS RMS Error yo "for Two-Axis Result; 


Test Run 

20 Minute 
Updates 

40 Minute 
Updates 

60 Minute 
Updates 

1 

— 

— 

— 

2 

3.8 

3.2 

— 

3 

6.6 

7,1 

— 

c 

4.5 

5,3 

6.5 

rms (2- axis) 

5.1 

5.4 

6.5 

rms (l-axis) 

3.6 arc sec 

3,8 arc sec 

4,6 arc sec 


Table 10-5. PADS RMS Error y„ for Three-Axis Results 


Test Run 

20 Minute 
Updates 

40 Minute 
Updates 

60 Minute 
Updates 

1 

2 

7.3 

4.6 

— 

3 

8.6 

23.3 


4 

8.9 

6.6 

15.0 

rms (3- axis) 

8.3 

14,2 

15,0 

rms (1-axis) 

4.8 arc sec 

8.2 arc sec 

8.7 arc sec 




















n. COMPONENT ACCURACIES 


As a by-product of the system tests certain measurements of the 
performance of the individual star trackers and -'yros were obtained. These 
measurements are presented in this section. 

11.1 STRAPDOMN STAR TRAC KER 

As described in Section 4.3 the automatic autocollimator null bias was 
calibrated immediately before each star transit during a' test run for the 
strapdown system test. This was accomplished by first pointing the parallel 
star and autocollimator beams at the theodolite, and then pointing them at 
the star tracker. While in the latter position, the tracker outputs as well 
as the autocollimator signals were stored on magnetic tape. Thus a measure 
of the boresight stability of the tracker was obtained before each star 
transit, i.e., every 20 minutes. Figure 11-1 is a plot of these measure- 
ments for the 12 star transits in the 1 October 1975 test run. Figure 11-2 
is a plot of the mean of a run's measurements for the four runs made during 
the ten day test period. The fifth measurement in the plot was obtained 
from the initial data of a test run on 10 October 1975. This run was aborted 
due to an electronics failure in the data transmission equipment. The error 
shown in Figure 11-1 is probably due to the laboratory instrumentation error's. 
However, the error shown in Figure 11-2 does reflect the drift of the bore- 
sight over a ten day period since the run-to-run repeatability of the labora- 
tory instrumentation is 0.6 arc second (3a) (see Table 4-1). 

In addition to the static boresight measurements, dynamic measurements 
of the star tracker accuracy were obtained for each star transit. The 
magnetic tape data from a test run was processed in an offline timeshare 
computer program. This program compared the compensated tracker outputs 
with the air bearing table compensated readout and prior knowledge of the 
star positions. The resulting error signal was passed through an RC filter 
with a 20 second time constant in order to smooth the tracker noise. Fig- 
ure 11-3 through 11-14 are plots of the error signal for the 12 star transits 
of the 1 October 1975 test run. The beginning of the transit occurred on 
the right side of a plot, and the signal moved from right to left. This is 
evident in the vertical axis error signal of Figure 11-6 which shows two 
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sudden jumps in the data and their subsequent decays. The dynamic lag of 
the star tracker track loop is apparent in the horiaontal axis error signal 
for all of the transits. The analytical calculation of this lag {Volume I) 
was 0.8 arc second, which is in good agreement with the plots. The 
star sequence for the 12 transits was 1,2, 3, 1,2, 3, etc. Examination of 
the four plots for any particular star does not reveal a clear indication 
of a systematic error resulting from the polynomial compensation of the 
tracker output. This error is indistinguishable from the filtered tracker 
noise. 

HORIZONTAL 

ERROR 

< ARC SECONDS) 



VERTICAL 

ERROR 

(ARC SECONDS) 



Figure 11-1. Static Boresight Error for 1 October 1975 Test Run 




























11.2 GIMBAL STAR TRACKER 


The static boresight measurements recorded during the gimbal system 
test differed from those of the strapdown test in that each measurement was 
for one of the three different stars, not all for the middle star. The 
measured star positions immediately prior to the ten day system test are 
given in Section 4.1. The average deviations throughout a test run from 
these values are shown in Table 11-1 under the column absolute error. The 
table also lists the errors in the locations of the upper and lower stars 
relative to the center star. 


Table 11-1. Static Boresight Errors fot the Gimbal System Test 


Test Run 

Star 

Absolute Error 

Relative Error 

AZ 

EL 

AZ 

EL 

8 Feb 76 

1 

-0.5 

0.1 

-0.4 

0.0 


2 

0.1 

0.1 

0.0 

0.0 


3 

0.4 

-0.2 

0.5 

-0.3 

9 Feb 76 

1 

1.8 

-1.2 

0.4 

-0.4 


2 

1.4 

-0.8 

0.0 

0.0 


3 

3.9 

-0.9 

2.5 

-0.1 

11 Feb 76 

1 

2.5 

-0.1 

0.2 

-0.1 


2 

2.3 

0.0 

0.0 

0.0 

1 

3 

3.2 

-0.5 

0.9 

-0.5 

16 Feb 76 ^ 

1 

1.0 

-0.4 

-0.3 

0.3 


2 

1.3 

-0.7 

0.0 

0.0 


3 

1.9 

-1.6 

-0.6 

-0.9 


The relative errors are presented to indicate the accuracy of the 
laboratory instrumentation. These errors will be independent of bias shifts 
in either the optical sensor or the gimbal readout. With one exception, 
these errors support the accuracy assumed for the laboratory instrumentation. 
The exception is for star 3 azimuth during the 9 February 1976 run. Both 
the absolute and the relative errors appear off by 2.5 arc seconds. No 
explanation for this discrepancy was found. In general the absolute elevation 
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errors are small, while the azimuth errors are in the region of one to two 
arc seconds. These errors are believed to be indicative of the boresight 
stability of the tracker. 

11.3 GYROS 

The magnetic tape data for all eight test runs of both system tests 
was processed to indicate the drift stability of the gyros throughout a 
particular test run. Figures 11-15 through 11-22 show the attitude output 
stability of the three gyro axes for the eight test runs.' The actual gyro 
output was a ramp function when plotted against time. In order to clearly 
show the ramp irregularities, the figures plot the output minus the ramp 
defined by the start and end points of the data. 

In general the plots verify the performance measured previously for the 
gyros and presented in Appendix C. An exception, however, was the perfor- 
mance of the z gyro for the last three runs of the gimbal system test. 
Unexplanably, but fortuitiously in view of the three-axis requirement of 
the test, the performance was much improved. 



Figure 11-15. 10/01/75 Run 
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Figure 11-16. 10/03/75 Run 



Figure 11-17. 10/06/75 Run 












12. CONCLUSION 
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Both the strapdown and gimbal PADS met the accuracy goal of 3.6 arc 
seconds (la) per axis as demonstrated by the laboratory tests. The strap- 
down PADS accuracy of 2.3 arc second actually exceeded the goal by a con- 
vincing margin. The gimbal PADS accuracy of 3.6 just equaled the goal. It 
is noted that the gimbal accuracy was derived from the gimbal two-axis 
results which did not include the detrimental effect of the limited 38° 
separation between stars. 

The laboratory tests have demonstrated that either system, under 
laboratory controlled temperature and vibration environments, will meet 
the design goal. 

In a comparative senses the performance of the strapdown system exceeds 
that of the gimbal system even more than the 20 minute update accuracies 
indicate. As pointed out in Section 4.1, for equal probabilities of star 
acquisition the gimbal tracker update interval should be 32 minutes if the 
strapdown tracker interval is 20 minutes. Although the quantitative effect 
of the longer update is not clear from the parametric results in Section 
10.3.4, it is certain that the accuracy of the gimbal system will be even 
less for the longer update. 

Also in a comparative manner, the alignment complexities associated 
with a test evaluation of the gimbal system, specifically the gimbal star 
tracker, are more numerous than those of a comparable strapdown system 
with two star trackers. These complexities arise primarily from the 
inability to directly identify the gimbal axis with an optical flat in the 
presence of a 1 g field. In another aspect, the hardware connected diffi- 
culties encountered with the gimbal star tracker provided a reminder of 
the comparative complexity of that unit relative to the strapdown star 
tracker. 

The substitution of the OAO gyros for the originally intended Bendix 
gyros turned out well in that the anomalous behavior of the normally higher 
performance OAO gyros made their random drift rates comparable to those 
expected from the Bendix gyros. On the other hand, the drift rate vari- 
ations of the X and y gyros were decidedly deterministic, displaying a 
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squarewave variation in rate which did not fit the assumed statistical 
models. Also, the performance of the z gyro was much poorer than either 
the z or y gyros, necessitating an artificial rotation of the gyro axes 
in the strapdown test to eliminate its effect from the two-axis results. 

It also invalidated one of the four gimbal test runs. 

The attitude error convergence plots for both systems indicate that 
the limiting factor for the 20 minute update intervals is the star tracker 
error. The independent evaluations of the tracker noise and bias errors 
led to the conclusion that the software algorithms, and the Kalman filter 
in specific, did not add significantly to the total error. In this area 
the primary emphasis of the laboratory evaluations, namely, the star 
trackers and the algorithms, was fulfilled. However, the 40 and 60 minute 
update intervals presented a different case. Here the anomalous behavior 
of the gyros became dominant, and the Kalman filter understandably was 
unable to compensate for the sudden drift rate changes between star 
updates. 

In terms of development status then, both star trackers have proven 
their performance capabilities and appear ready to proceed to flight level 
designs and environmental testing. The one reservation, however, involves 
the strapdown star tracker hysteresis described in Volume I. In many 
applications this effect is undesirable, and efforts are now underway to 
identity and eliminate it. 

The results obtained in the area of minimizing the laboratory instru- 
mentation errors justify the ground-fixed test configuration chosen for the 
system tests. The predicted instrumentation errors of 0.9 and 1.6 arc 
seconds for the strapdown and gimbal tests, respectively, most probably 
were achieved in view of the overall test results. The advantage of pre- 
senting PADS attitude errors as computed, without qualifications for 
hypothesized instrumentation errors, outweighs the subtle aspects involved 
with the ground-fixed configuration. 

While the ground- fixed test configuration did minimize the instrumen- 
tation errors, it also made clear that the limit in test accuracy for star 
trackers and attitude determination systems was reached using commerci ally- 
available instrumentation. The most obvious limitation was the theodolite. 


While the Kern DKM3 is one of the best, if not the best, such instrument 
available, obtaining better than 0.5 arc second accuracy with the instru- 
ment is doubtful. Another limitation is the parallelism and perpendicu- 
larity accuracies of mirror surfaces. Procurement of such mirrors with 
specifications below one arc second is not only costly but often beyond 
the capabilities of most optical suppliers. Stability and collimation 
accuracy of star sources is another limitation. Even with the thermally 
passive approach used in this program, material creep and long-term defor- 
mations will often require months of settling time after initial installa- 
tion to achieve better than 1 arc second stability. 

It seems clear that if star trackers or attitude determination systems 
with sub-arc second accuracies are developed, a significant increase in the 
cost of testing such units or systems will be experienced. A large part of 
the test cost will be the development and certification of the precision 
test instrumentation required. 
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APPENDIX A 

DATA ANALYSIS PROGRAM LISTING FOR THE 
STRAPDOWN SYSTEM TEST 
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OOlCO 
CCllC 
0C120 
00130 
001^0 
00150 
00160 
00170 
00180 
00190 
00192 C 
00194 C 
00200 

00203 C 

00204 C 
002C5 
00206 
00210 
00212 
00220 C 
00230 
00240 
002 SC 

00255 

00256 
0026C C 
00260 
00310 

i 00320 C 
! 00330 C 

00340 
00350 C 
00360 
00370 
00375 
00380 
0039C 
C04C0 C 
00410 C 
00420 
C044C 
f 00460 



doQC-PAM pads ( IhPtT,LlUTPUT>TAP£i>TAP£2»TAFE4#TAPE5) 
rPM^OM/l / !')G> ND6Lr,NM 

pnMMnM/,‘>/TIMt:;^TO,lF#rjELT,KCELT»Xl (4) ,X1L(4),KSKP 
rnMMn^/?/PiM6(12)#TAU(3^6)/l«M6)^ DRFT(6),GY(9#6) 
CnMMDN/4/PHri(4^4), PHI2(4 j3)jQ(7#7>>Q0(4,6)j WR( 3/ 2)^RP(4>4) 
CnMMnN/5/SSV(27>2)>PP(3)»3(3>3/2) 

Caf*,MnN/6/NTP,ICAT>N0^YLi2»2> 

Ci?MM0N/7/Yn(i,2), V {2,2),UU5>^ AST (3^3,2 )# SIR (3^2) 

CnMMnM/R/pf 7, 7),f< (2,2),AK(8#2 ),HMAT(2,7) 

OrMFMSinN GYl)AT(500,12)>6X1{12)^GX2{12)_>HSTR£12) 

KTYP=0 - REAL LAB iKTYP«l - GYROS REDRIENTEDi 
KTYP»? - TOEAL GYRDS 
DATA KTYO/1/ 

MSTP{T) ncMmgs w'hfcTHbk THE I TH VISIQLE ’sTAR" IvILL BE USED ’ 

FOR FUTFPTNbi IF SG> HSTR(I)=1 

DATA (MSTP ( I), I =1,12) /I, 1,1, 1,1, 1,1, 1,1, 1,1,1/ 

5 FnPMAT(X,7HKfVp = ,11/) 

1 CONTINUE 

N7«3 _ _ _ _ _ 

PFWTND TAPES 
REWIND 1 
REWIND 2 
REWIND 4 
REWIND 5 
WRITE(P,5) KTYP 

EFFECTTVFLY ELIP.INATE THE FIRST DATA LINE 
RFAn(4,P ) (GYDATU, J), J = l,12) 

NN1=3 

PCAD TN AND PRIM OUr INITIAL VALUES, SYSTEM PARAMETERS AND RUN 
CONTROt CONSTANTS 
CALL INPUT 

INTTIALITE counters and FLAGS 

NXC=KPP=NC=o 

ICtYsSOO 


MT = 0 
N0 = 1 

PEAD(4,2) (GXK J), J=1,12) 
prrTNNT'''r- nr FILTER LOOP 

TMTTIALT7P SUTl IRANSITILN f-ATRICES PHll AND PHI2 

i ;> r Nn ; i : 

CALt 7EP^ 

pr. r ” MTT‘'Pr 

C. Ijf 4 . V . 


eepkobucbiuty op the 

OEXSfNMi PAGE IS POOR 
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00490 C 
C050C 
00510 
O05Z0 
00530 
00540 
00550 
00560 
00570 
0056C 
00590 
00592 
C0600 
00610 
00620 
00622 

00623 

00624 

00625 

00626 
00630 
00640 
00650 
00660 
0067C 
00660 
00690 
00700 C 
00710 
00720 C 
00730 
00740 
00750 
007fc0 
0077C 
00B90 C 
00900 
00910 
00920 
00930 C 
00940 
00950 C 


TSncxpTUFtN TtST FOR WHETHER KtW Fi.lGHT GYRO uATA SHOULD Bt READ 
TCY=IGY+1 

IFf IGy.! r.<50U> Gu TU 23 
TGY = 1 

rn ?4 T=i»5oo 

(GX2{ J), J=i,12) 

0LT=GX2(1)-GX1(1) 

GYnAT(Tjl)=Gxl(i) 

17 K = ?»4 

17 6Yn4T{T*K) = {&X2{K)--GXl(K) J /DLT’*‘4.84B136 g£- 6 
TF(’<TYP.EO.C ) GO TO 25 
T'^(KTY'>.E0.1 ) GU TO 26 
GYDAK T,?) S-.A.68164026E-5 
GY9ATn#3)-~4,49496700E-5 
GYDAK T,4)=A.57512760E-5 
GO TH 25 
26 CONTINUE 

GYDAT(T»2)=CY0AT(I»2}+4 .26794875E-5 
6Y0AT{T#3 )=GYOATa> 3)+2.115715 88E-6 
GYDAT' Tf 4)=r^Y0AT{ I,4)+1.979413 84E-5 
25 CHNTTMUF 

DO 1'=' K = 5»15’ 

16 GYnAT(T,K)=GXl{K) 

DO 19 K=l,32 
19 GX1(K)=GX2(K) 

TF(FnE#41 23,24 
24 r^NTINliF 

FPQ.MAT ? TS BELSKYS TAPE FORMAT 
2 FOR M AT (X,F1 0.3,3 C F12.1) J F3, X,3 (F7.1,X),4(F5.1,X ) ) 

FORM TIME AND INTEGRATION STEP 
23 C^NTT^'UF 

PFLT=6Y0AT( TGY,1 )-TIME 
TIMfs:(;Yr<AT{IGY,l) 
on 33 T = 1 f NG 

33 WM{ T) *GYt)AT( IGY, I+l) 
test pnp END OF RUN 
TF(TTME.LT,TF ) GU TO 43 
STOP 

43 rONTTWiiF 

APVA^nF ?TATt PRINT CUUnTER 
NVCsMXr +1 

COMPUTE FSTTi'iATEO SPACECRAFT oCDY ANGULAR RaTLS 









00960 CALL GYPCK 

00970 c rpMOUTP fSTTMATEO SPACECRAFT ATTITUDE 

009CO CALL ATT 

00990 C TTMP TV p^INT STATE 

OiOOO IFCNXCa T.NDtLP) ^4,81 

' 01010 81 CQNTTNUF 

01020 C FROM FSTIMATED SPACECRAFT ATTITUDE DIRECTION COSINE MATRIX 

01030 call TPMS 

01060 C PPTMT ESTIMATED STATE 

0107U CALL VIPPNT 

01140 MXC=0 

; 01150 C IF KPRrl,THIS PRINT FOLLOWED A FILTER OPERATION 

.01160 IF(KPP.EO.l) 48# 44 

01170 46 KDR=0 

01160 GO TH 15. 

01190 44 CONTTNUF 

01230 C TFST TRACKER DATA IS PRESENT 

01240 IF(GYDAT( TGY,5} .GT.0.5) 60#52 

01250 52 NF=-KSKP 

01260 GO Jn ?o 

01300 60 CONTIMUF 

: 01310 IF(GYnAT(IGY,5},LT.1.5) GO T0_ _601 

01312 MT = MT+i - 

01320 OVl*GYnAT(XGY#ll) 

; 01330 DV2-GYDAT{IGY#12) 

01340 eol conttmuf 

01350 NF=NF+1 

01360 IF(MF.t T.l ) GO TO 20 

01362 C test whether THIS STAR IS ACCEPTABLE 

01364 TF(.MSTP (MT) .NE.l) GO TO 52 

01370 TUaGYnAT(TGY#6)-0Vl 

01360 TV = CYnAT( If^Y» 7)-DV2 

01390 TA7=-.032P266874 + SSV(4#1)*TU +SSV ( 5#1 ) #TU*TU +S S V { 6# 1 ) *TU¥=i=3 

: 014GC 1 + SSV{7,1) *TV + SSV16#1)«TV*TV +SSV ( 9# 1 

01410 2+SSVnn,l)«TU>!‘TV +SSV(11#1) =S'TUtTU=«TV + SSV( 12# 1) «TU*TV+«2 

J 01420 TFL=-.4026Q17G6+SSV(13#1) TV + S S V ( 14 # 1 J 'S^T V=i‘TV + SSV ( 15# 1 ) 

G1430 1^TV**3 + SSV( 16#1) «TU + SSV ( 17# 1 } *TU*TU + S SV ( 1 8# 1) ^TU+^^'S 

01440 2+SSV(lQ.#l) «T\/4TL+SSV{20jl) *TU*TV=i'«? + SSV { 21# i ) -!‘TV*TU+=S‘2 

01450 YL n # ’) =Y(1 # <; J 

01460 Yl. (7* P ) = Y(?, 2 ) 

01470 Y(l»?) =-TA7+9. e4cl36dlE~6 

: 01460 Y(?»2) =TPL *-t . 6*»Li3b81E-fc 



01490 c 

01 5(J0 
01610 
01520 
01530 

01540 62 

01550 61 

01560 C 
01570 
01580 C 
01590 
01600 
01610 
01620 C 
0163C C 
01640 
0X650 C 
01 660 

01670 72 

01660 3 

01690 

01700 70 

01705 

01706 4 
01710 
01720 
01730 C 
01740 
01750 C 
01760 C 
01770 
0176C C 
01790 
01795 
C1800 C 
01810 
01820 C 
0183C 
0184C C 
01850 
01860 C 
01870 


AIR Rcac-IMG TA6LL ANGLE CGMFUTATIQN 
T^ = 6. ’05615l2E-4fGYtJAl ( IGY,6) 

FPl + i ,?¥SlNnD)+Cod«CaS(TD) 

T'^t. =~(GYnAT( iGY» bJ / 2 *-bPl ) “^4 o d4ei3661t-6~2. 3y6i94^9 
TF(Mr.F0.11 62,61 
CALL STPCHK(IBL) 

FONTTMUF 

rn^iouTF TNFPTIAL STAR DiR. COS, 

CALL STAP[)C( STR(i,l ICATjTBL) 

COMPUTF c$T. TkACKER OUTPUT 
CALL TPAC 
CALL TPCFLT 
TF(Ntr.LT.lO) 60 TO 20 
START FTLTFRING 

CHMPl'TF TRACKER MEASUPP.EnT RESIDUAL NO M 
UI=SOPT{ (YD(i,2)“YD(l,i) )«*2+(Y0(2,2)-Y0(2,l) )**2) 

DHFS TT fall within AN ALLOWABLE ERROR 
IF(Wl.t T.,1) GO TO 70 
PRINT 3.W1 

Fnp«/vT( POHMcaSUREKEn! ERROR I S, 2X, E13 . 6 ,6ri, PUNT) 

STOP 

COMTINUF 

WPTTF(5,4) TI!1E,W1,N7 
FnPMATt2(?X,E13.6),2X, ID 
call XIPPNT 
NF=~KSKP 

FORM STATF NOISE ERROR COVARIANCE MATRIX 
CALL QMAT 

ALTER STATE TRANSITION MATRIX TO DEAL WITH 3 RATHER THAN 4 
ATTITUDE variables 
CALL PPFIL 

PPnpAFATF state error COVARIANCE MATRIX 
CALL >=ILT 
CALL '’PHT(T) 

FORM HEASUPMENT MATRIX 
CALL HMTRX 

FORM measurement NGISE COVARIANCE MATRIX 
CALL Pf^AT 

APPLY KAL'^AN algorithm 
f l-l L FFTl T 
UPDATE STATF 

CALL PCFTL 


OltiBO 

c 


ADVANCE FTITER CCLNTER 



016v0 



MPr-NPC+l 



01900 

c 


TYVF TP STATE ERRjR COVARIANCE MATRIX 



01910 



TF(NPr-NFP) 15>c0>e0 



01920 


80 

CONTINUE 



01930 



CALI PD-NTd) 



01940 



KDRs] 



019:^0 



pn oj 



01960 



FMH 



01970 

c 





01960 

c 





01990 



SUBPOUTTNE TRNS 



02000 

c 


COMPUTE niPFCTION COSINES OF SPACECRAFT ATTITUDE 

RELATIVE 

TO 

02010 

c 


ATTTTunF PFPERENCE AXES(ECI COORDINATES) 



02020 



nNMnN/?/TTME>TC#TF,DELT>K0£Lr/Xl{4},XlL(4) 



0203C 



C'iM.MnN/5/«:cv(27,2>,PP(3)#B{3#3j»2) 



02040 



niMENSTHN T{4/4) 



02050 

c 


TRANSFORM FULER SYMMETRIC PARAMETERS TO DIRECTION 

COSINES 

RELATIVE 

02060 

c 


TO ECI AXES 



02070 



on 10 T = 1,3 



02080 



T(T,T) * XI (4) 



02090 


10 

CONTINIJP 



02100 



T(1,2)«X1 (3f ‘ 



02110 



T(1,3)»-X1(?) 



02120 



T(l,4)*Xin ) 



02130 



T(2,3}=X1(1) 



C2140 



T(2,4)=X1 (2) 



02150 



Tf3,4)=Xl(3) 



02160 



T(2,l) = -T(I,2) 



02170 



Tf3,l) = «T(1,3) 



02180 



T(3,2) = ~T(2,3) 



02190 



T(4,l ) = T(1 ,4) 



02200 



T(4,?) a T(2,4) 



0221C 



T(4,3) = T{3,4) 



02220 



1(4,0 = -XI (4) 



02230 



D'1 4C 1=1,3 



02240 



no 40 J=2,3 



02250 



P(T,J,l) = f'. 



02260 



DO 40 K=7,A 



02270 



P(T,J,l)= l + T CI,R)-«‘T{K,J) 



02280 


40 

roMT jW(jF 



02290 



PPTU!>Ni 




A-7 


0230C 

02310 C 

02320 C 

031C0 

03110 C 

03120 

03130 

03140 

03150 

03160 

03170 

03175 

03180 C 

03190 

03200 

03210 

03220 

03230 

03240 

03250 

03260 

03270 

03280 

03290 

03300 0 

03310 

03320 

03330 

03340 

03350 

03390 C 

03400 

03420 

03520 

03530 

03570 

03590 

0360C 

03610 

03620 

03630 

0364G 




SIlRonyTlNF VIPkNT 

opTNT? ESTIMATED STATE VECTOR AND S/C ATTITUDE MATRIX 
COMwinN/l /NO,hDELP>NNl 

COMMON /?/TTf^E » T0» Tf » Ot L Tj KD E L T, Xl (4 ) j» X1L( 4) 

CQMMnN/?/0TMu(l2)^ TAU(3»6)»WM{6)»DRFT{6)*GY(9»6) 
rCMVnN/5/SSV(2?i2),PP(3)»B(3# 3, 2) 

DIMENSION r{3#3),D(4> 

rA=206264,fil 

N7=l 

PPINT MJAniNG AND TIME 
WPITE(2.30) TIME 
CALL f ARATT 

DO 60 I = T» 3 , 

DD 60 J=Tt3 
cn» J)=0. 
no 60 K=l»3 

60 C(I,J )=C(Tf J)+B( If J#K>2) 

P(1 )-CA*C(2» 3} 

)=C A*C (3, 1 ) ... 

Dn) = CA*C(lf2) 

D { 4 ) « SORT { n { i J ««2 + D ( 3 ) *=5=2 ) 

PRINT ESTIMATED EULER PARAMETERS AND S/C AND LAB ATTITUDE MATRIX 
WRTTF{?f20) (IfXKDfBdflfl) »B(I>2fi)ffl(I»3fl)f 
IBdflf 2).B(T,2,2)f B(If 3f 2)fO(I)f I»lf 3) 

WPTTE(2,221 Xl(4) ,0(4) 

WRTTF(5f23) TIME,D{4),N7 
23 FnRMAT(2(2Xf tl3.6)#2X,ll) 

PPINT HEAHING 
WPTTFtPf 50) 
on 45 I=lfNNl 
PIMUlA=rA*PTMU( 1 ) 

WPITF(2,21) ifPIMUlA 
45 CONTINUE 

30 FnPMAT(X///PH TIME = ,£l6.9//30Xf 

150HFSTIMATFr> SPACECRAFT ATTITUDE RELATIVE TO EC 1 AXES//X, 

?3M.N.n, , X, IIHFULEF P AR Ah » 1 2 X » 17ri ATT I TUD c £S TI M A TE » 27 X* 

3TPHLAP ATTITuDtf 12Xfi2HR,Pf YfKSS ER//) 

2C FPRMAT(X»TlfHXfFiZ»9fXf3(XfF12.9),2Xf3(X,F12»9),2X,F9»2) 

22 FnPM^T(Xf 1H4 ,2Xf F12.V, 83Xf F9.Z) 


03650 5C 

03660 21 

03670 

03680 

03690 C 

03700 C 

03710 

03720 

03730 

03740 . 

03760 

03760 

03770 

03775 

03780 C 

03790 C 

03600 C 

03810 

03620 

03630 

03840 C 

03850 

03860 

03870 

03860 

03090 

03900 

03910 

03920 

03930 

03940 

03950 

03960 

03970 

03960 70 

03990 

04000 

04010 

04020 

04030 75 

04070 
D41Li. C 


FHi?MAT(X/14X^ 26HESTIHATED GYRO BIAS VECIOR/1 
cnpMAT(15X, II,4X, E12.5) 

PETUPM 

ENO 


SUBPOUTTNE PRNTtKl) 
f nMMHN/i /MG, nDELP#NM 

CnMMr)M/2/TTMt^T0,TP#DELT,KDbLT,Xl(4),XlL(4) 

CnMMrjM/A/MTP,ICAT^M0>YLt2jZl ... 

CnHM0N/7/Yb( 2>2) > Y{2,2),U(15),AST(3,3,2),STR(3j2) 
CnMMnM/8/P(7,7)^R(2#2), AK( 8 j» 2 )pHHAT( 2,7J 
DTflFMSTQN PT13,3)/F(3?3J^TP<3/3J 
N7 = ? 

PPTNTS THE ERROR COVARIANCE MATRIX, UPPER LEFT 3 BY 3 IN 
S^ALL ANGLE FORM 
SAVE UPPER 3 BY 3 
on 40 1=3,3 
on 40 J=l,3 
PT(T, J)=P(T, ji 

CONVFOT UPPFR 3 BY 3 OF P MATRIX TO SMALL ANGLE FORM 

F(1,1)=2.*{XH4 ) +X_iy.)*=«' 2/Xl(4J ) 

F(l,2J=?,*{XU3)+XlUjixi (2~)/xi(4n 
F(l,3 (XII 2 )-Xlti)«Xl (3) /Xl(4n 

F(2,T) =“2,*(Xlt3)-'Xl(2)«'Xl(l) /XK4) ) 

F(2,2)=2,«(X1(4) +X1(2 )=«'* 2/X1{4) } 

F(3,3)=2,*(Xi( i)+Xl(2)«Xl(3)/Xl(4) ) 

F(3,l 1=?.4(X1 (2)+Xl(l)+Xl(3 )/Xl(4) ) 

F(3,2)=-?.*( Xl(i)-Xi(2)#Xl(3) /XK4) ) 

F(3,3)=2 .>S'(X 1C4J +X1(3)««2/X1(4) > 
on 70 1=1,3 
00 70 x1 = l,3 
TO{ I, J )=0. 
f)P 70 K = l,3 

TP( T, J}=TP(T, J}+P( I,K)«F( J,K) 
on 75 1=1,3 
no 75 J = 1 ,3 
p( T, J) = 0. 
f)n 7S R = l,3 

P(T,J) = P{I,J)+Fn,KJ»TP(K,J) 

NA = NNl+3 
PPTNT MFAriT''G 


;■ 

M 

' 04U0 

04120 
1 04130 

i 04140 
I 04150 
04160 
■ 04170 

04160 
04190 
0420C 
04210 
04220 
' 04230 

04240 
04250 
04260 
04270 
O'* 2 80 
04290 
04300 
04310 
04320 
i 04330 
04340 
04350 
0436C 
0*'-365 
04366 
04 370 
04 360 
04390 
04400 
I 04410 
i 04420 
:i 04430 
I 04440 
i G4450 
I 04930 
I 04940 
I 04950 
1 04960 

04970 



10 v. = ITP(2,l) 

1 .50X/CHP MATRIX) 

r)n -»n 

WPIT!:(9,?) I 

3 FOPMAK /PX,4HK0W #12/) 

C PRIMT P MATRIX 

20 WPITE(?,30) (PC 1# J)# J = 1#KA) 

30 PHRMATf 3X,6F17.fc) 

IF(K1.P0,0) Gu TD 44 
C PRINT STAR NUMBtK 

5C WRTTF(2,45) ICAT 

45 FPP«AT( / 7X#14HSTAR NUMBER «= #13) 

TST?=ATAN2(YD(2#2)#1. ) 

TST1 = ATAN?( YD (i#2 )=»=CQSnST2)# 1. ) 

TT = ATAM2(Yn(2,l)#l. ) 

PPL 2= {TST2-TT) ’*=2 06264,61 

DEL1 = (TST1-ATAN2( yD( 1#1 H'CDSLTT)#!, ) )*206264, 8i 
WRITF{2#60) TSTi#DELl#TST2#DEL2 
60 FnPMAT(3X,37HTRACHER OUTPUT ANGLES AND MEAS. tRPCf/ 

15X, 7MA7IMUTH#2X#Ell,4#5H RAD.#3X#F10,3# 

27H APCSFC/6X#5HELEV #3X#E11.4#5H KAD.# 3X# FIG . 3# 

37H APCSFC) 

44 CPNTINUF " 

AT = SORT(P< 1# 1 ) +P (3#3) ) ♦206264.81 

WRITF(2#3Q) at 

39 FnPMAT{?6H SORT OF POINTING TRACE = #Fio.3#VH ARC StC.) 

WPITF(5,a) TIME#AT#N7 
8 pOPMAT(?( 2X, ei3.c)#2X, 11) 

DISPLAY AT 

c pfstdre p matrix 

on 43 T==l»3 
DP 43 J = 1.,^ 

43 P(Tf J )=PT( T# j ) 

RFTURn 

END 

C 

c 

FUBRrUTTME T,\puT 

C PPAPS TN PRIMS INITIAL VALUES# SYSTtN P AHA^tl EPS# RUN CuMPDL 

C CONSTANTS, AND CGNVtKTS SPtCIFIED ANGLES 10 RADIA^S 

CnMWDM/l/NG# nOELP#NN1 

f >^v.f,nM/?/TIML# TC# TF#OLLT#KObLT# X1(4)#X1L(4 )#KSnP 

A-10 
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0^9b0 

0^990 

ostuo 

o;>oio 

0^,020 

05030 

050^C 

05050 

G506C 

05070 

05080 112 

05090 C 
05100 

05110 2 

0512C 

05130 3 

05150 C 
05160 

05170 20 

05160 4 

05200 C 
05210 
05220 

05230 24 

05240 5 

05250 C 
C5260 

05270 25 

05260 C 
05300 

05310 27 

05330 6 

05340 C 
05350 

05360 22 

0537C C 
053oC 
053VC C 
0540C C 
0541C 

05420 26 

05‘t7C C 


rnMMnN/3/PTf'u(12)>TAU{3,6) jWH(6)>DRFT (6)> GY {9»5) 

1( ) ,PHI2 (4^ 3) »Q(7j7)»C0{4,b) ,i^R(3>2)»NP(4#4) 

''nMMnKj/5/5<;V(27^2)^PP(3)^rii3,3,2) 

CnvMpM/6/NTP, ICAT/NO# YL {2i 2 ) 

rnMynM/7/Yn( 2,2), Y (2,2) » Ut 15), AST (3^3,2 )#STR( 3,2) 
CnMMnN/p/P(7, 7),R(2,2), AK18,2),HMAT(2,7) 

DT^^EMSinM MSV(4,32),C (3,3), T(3) 

KIM = NNT +3 
n? Ti'> T = i,Mh 
nn 112 J=1 ,Hh 
P( T, J)=0( T, J )=C. 

RFAO INPUT plAGS OEFINING TYPE OF RUN AAND PRINT OPTIONS 
RFAHd,?) NTk,NG 
FHPM AT { II ) 

PPAnn,3) NntLP,KSKP 
cnpMAT(I3) 

RFAH NPHINAL STAR TRACKER TRANSFORMATION MATRIX 
'>0 20 K = 3 ,WTR 

PFAnn,4) ( { ASTd, J,K), J = l,3), 1 = 1,3) 

FPPmaK P9.6) 

PFAD STAP SFNSQP. PARAMETERS 
on 24 J=1,NTR 

PFAnd,6) (SSVtI,J),i=l,21) 

RFAD(1?5) ( SSVd, J),I = 22,27) 

FHRMAKFQ.R) 

OFAO GYR*^ parameters 
on P 5 ,1 = 1, fir 

PFA0d,61 (Gi (1, J),I = 1,9) 

OFAH FSTTMATED INITIAL RATES 
m 27 7=1,3 
PFA0d,6) PPd) 
cnpMA7{rd,6) 

PFAn TNITTAl 4 PAkANETER ATTITUDE 
P<=AD(1,4) tXid), 1 = 1,4) 

C^MTTMUF 

PPAO tkjTTTAI and final TIMES AhlD INTEGRATION STEP SIAt 
0FAnd,6) Tn,TF,D£Ll 

OF/^n F(?r>no r uVAR iANCE INITIAL DIAGONAL tLcMLNlS 
AP' PAD., SEC 
nn na j = i , 

0FAn(i,6) P(1,I) 


05,^90 

C 


TPMPnOAPY P'i-ur fPlNT RGUTlNt 

OtiDCO 



WPTTf ( •’, 1 ? ) 

055) C 


12 

FHR'iAT f 1 HI 1 

0552& 



W0TTF(?.7) ^;TR^hG^ NDELP 

055A0 


7 

FHPMATt 3tX»I3)/) 

05560 



Pn J=!,NP 

05570 


31 

VlPITFt?,8) t GY( J }/I«1^9) 

05580 


8 

pnRMfl j(0( x#Fi0.3 ) ) 

05590 



WOTTF(?,10) 

05600 


10 

FORMATt/l 

05610 



on 3? K=1,NTR 

05620 


32 

WRITF ( 2> 9) { ( ASTt J#K) » J=l>3)> I=li3) 

05630 


9 

F9RhlAT(9(X»F9.6) } 

056A0 



WPTTF{?,10) 

05650 



or? 34 xt*l.^Tk 

05670 


34 

WPTTF{?,11) (SSV{ 1=1^27) 

05680 


11 

FnRkAT(9{X,Fi0,3) ) 

05690 



WRITF tF.lO J 

05700 



on ?5 J=1.3 

05720 


35 

WPITF(2,P) PH(J) 

05730 


41 

rnMTI^OJF 

05740 



WfTTE(?,10) 

05760 



WRITF(?»P) (Xi(I)?I=l>4) 

05770 



WPITFr?>10) 

05780 



nn 37 K=1^MN 

05790 


37 

WPITF{?,P) PtK,K) 

05800 



WPTTFtPjlO) 

05810 



WPTTF{?,P.) TO,TF^OELT 

05820 



WPTTF t?j 10) 

05680 

C 



05890 

C 


TNTTIALTZF PkOBLEh TIME 

05900 



TTMF = TO 

05910 


15 

FnRMAT flH] } 

05920 



WPTTF ( 2,15 ) 

05930 

c 


CHMVFPT AMOI.es TD RADIANS 

05940 



CF ST 4 . P4®1 3o6E-06 

05950 



CFSQ = CF+CF 

05970 



on 130 J=1 »mir 

05980 



SSV( P4 * J ) (24, J ) *CF 

05990 



CSV (? = , .1 > =SS \/ ( 25, J ) *CF 

06000 


130 

COMTIMUF 

06020 



on 135 J=1,MG 










06030 
060*^0 
C6C50 
06060 
06070 
06080 C 
06090 
06100 C 
06110 
06130 
06180 
06190 
0620.0 C 
06210 C 
06220 
06230 C 
06290 C 
06250 
06260 
06270 
06280 C 
0629C C 
06300 
06310 
06320 C 
06330 
06390 
06350 
06360 C 
06370 
06380 
06390 
06900 C 
06910 
06920 
06930 C 
06990 
069 50 C 
06960 
06970 
06980 
06990 


GY(1> J)=GY(1, J)*CF 
pp i-?5 T = 7,9 
' GY{T, J)=GY( T, Jj-i-CF 
135 C'^NTTMUP 

CAll TNTTTAL 

PPTNT FFROP COVARIANCE MATRIX 
CALL PRNT(O) 

pdymt initial state vector 

CALL TPNS 

call XTPRNT 

PFTURN 

ENO 


SURPniJTINE ZERO 

TMTTIALTZES STATE_TRANSn.IflN.HAT8KES. PhU AND. BHI2...AE1&R _£ACJ1. 
FILTER UPDATE 
CDMMQN/1/NG* NDELPi>NNl 

CnMMDN/?/TI_ME^TO^TF^OELT^KOELT^X_l(.9>.#.XlLC 9) — 

COMMHN/A /0HTi(9^ 9)>PHI2(9 j3) »C(7^7)> Q0(9# 6), WR(3,2)>RP(9#9) 
RETAIN FILTER UPDATED VALUES OF EULER PARAMETERS FUR NEXT FILTER 

OPFP ATIPN 

DO 21 l=i»9 
xiun=xi(T) 

SET PHIT ELEMENTS EQUAL TO ZERO 

on 2? J=l,9 
PUT! ( I, JT-C. 

22 CnNTINUF 

SFT PHI? ELFHENTS FQoAL TO ZERO 
DO 23 J=1 jNN1 

PHI2( Tj. J)=0. 

23 C:’NTTNUF 

SFT PHTI OTAGCNAL ELEMENTS EQUAL TO ONE 
PMI1{T»I)=1. 

21 CPNTINUF 

SFT 0 MATRIX COMPUTATION INTERVAL COUNTER TO ZERO 
KnFLT=0 

SFT C MATRIX ELEMENTS TO ZERO 
PP 10 T=l»7 

P'> 10 J = l»7 

10 0(T»J)-O. 

PFTUPN 
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^ ! 

OO&OO END 

06!>1C C 
, 06520 C 

06530 ^UBRPDTINE INITIAL 

065^0 C'^mMON/I /NG# NDELP^ NNl 

. 06550 CnMMnN/?/TIM6,T0>TF^0ELUKDELT/Xl(^)»XlLC4) 

06i>b0 C0MMnN/3/PTMu(12)#TAUl3,6)#W«(61#DRFTi6)>GYC9>6J 

065 70 CnM'nN/-!i/oHTl('^,^ ),PH12( 4, 3)#a{7#7),o6('!t>6) ,WR( 3,2)>RP(^>4) 

06580 C'1NMnr^/5/5SV(27^2)>PP(3),B{3,3,2) 

06590 rnMM0N/6/MTP,ICATj>N0,TL_{2,2) 

I 06600 CrtMPnN/8/0(7,7)#R{2»2}#AK{8j>2)»HHAT(2>7> 

I 06610 niMENSrON TP1(3,3),TP2{3,3)?TP(3>12)^TP4(6,3) 

I 06620 C CHHPUrF GYRO WEIGHTING MATRIX^ JAU . 

06630 Pfl IP I = 1»N0 

06640 nn 1? J=l,3 

I 06650 12 TP4(r,J)=(l.+GY(2*I))»GY(3+J^ I) 

i 06660 OD 10 1 = 1 ji 3 

1 06670 DO TO J=l,3 

06680 TPl(T»v’)=0, 

06690 nn 10 K = 1,K'0 

06700 TP1(T>.I)=TPI (I,J) + TP4(K,I)*TP41K^J) 

06710 10 CONTINUF 

06720 DEL = TPKl>i >4TPl(2i2)*tPl(3>3)+TPl(l>2)=}=TPli'2j3)*TPl(3,l) 

I 06730 1+TP1(1,3)*TD1(2,1}*TP1(3»2)~TP1(1»3)^TP1(2^ 2)*TP1(3^1) 

06740 2~TP1(1,1)*TP1{2>3)«TP1(3,2 )-TPl(l>2 j^TPK 2>1)«TP1{3>3) 

06750 DL=1./DFL 

06760 TPPa,l)«(TOi{2,2)^TPl{3,3)“TPl(3,2)«TPl(2>3))4DL 

06770 TP?(1»2)=(TP1(3^2) >TP1(1#3)-TP1(1,2)4TP1(3^ 3) )*0L 

I 06780 TP2(1^3) = (TPia#2)=!'TPl(2#3)~TPl{2#2r«TPi(l,3} )«DL 

! 06790 T£*2(2>1 ) = {TPl{3>l)*TPir 2 j3)-TPI{2#X)*TP1{3j3))«0L 

06800 TP2f2,2) = {TPl( 1,1)*TP1(3,3)-TP1{153)=«'TP1(3,1) >«DL 

06810 TP2{?,3)=(TPl(2,i)*TPltl,3)-TPl(l^l)*TPl(2j3) )*DL 

^ 06820 TP2(3,l> = (TOi(2,l}=f=TPl(3,2)“TKl(3jl)«TPll2#2) )*DL 

^ 06830 TP2(3,?) = (TPl(3jl)«TPi(1^2)-TPl(l,l)<‘TPl(3,2) )*tlL 

06840 TP2(3,3)={TPiUjl)«TPl(2^2)-TPl(2jl)*TPl(lj2J)*DL 

06850 DP 15 1=1^3 

06860 nn 15 J=1,NG 

0687C TAU(T»J)=0, 

06880 nn i r k = T »3 

06890 TAUf Ti J)=TAIKI, j J + Tr2(I»K)#TP4( J,K) 

06900 15 C-"'NTTNUF 

0691C C JVTTTALTZE PAiT UAlA 
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OF THF 
IS POOT? 



06930 



20 T = 1»NT, 

069AC 



n'’ ?n j = i ,2 

069S-0 


20 

nPPT(T)=GY(Wl) 

06960 



nn 30 T = 1 » 3 

06960 


30 

WP(1,1)=WP(Ij2)=PP(I) 

06990 

C 


CHHOUTE INITIAL GYRUPACK PARAMETERS^ PIMU 

07010 



06 40 I»1j3 

0702C 



t»TMUf T)=0. 

07030 



nn AO J=1»NG 

07040 



P TNU { T ) = P T f'U 1 1 ) +T AU ( J ) « ( 1 , + GYJ 2# J ).) *G Y ( 1, J. 1 

07050 


40 

CnNTTNUF 

07070 



L = 3 

070 60 



on 5C T=l>3 

07090 



66 60 J=l»? 

07100 



L = L + 7 

07110 



PTMU(L)=0. 

07120 



on 60 K1=1#NG 

07130 



P TMU ( U = P I MU ( L ) + TAUlIjKl )=S=(l. + 6Yt2>Kl) J=fGY( 3+J,K1) 

07140 


60 

CONTINUE 

07150 



PI6U{4=f'I) = P THU {4=^1)-!, 

07160 


50 

CGNTINitp 

07170 

C 


compute tau*tau-t=?=sig-“Sq fop use in Q ... 

07ieo 



DO 65 J=1»NG 

07190 



TP3 = S0RT(GY(7, J j«>i=2’«^100.00>i‘DELT+GY(9# J)«=^2) /lOO. /DELI 

07200 



00 65 1=1,3 

07210 



TP(T? J+6)=TAu(I, j)*GY(6» J/ «SORT ( IGO.+DELT J 

07220 


65 

10(1, J)=TAU( I, j)*TP3 

07230 



66 70 1=1,3 

07240 



Q6 70 J=l,3 

07250 



00{ I, J )=0. 

07260 



00( T, J+3)=0. 

0727G 



on 70 K=l,MO 

07280 



00( I, J+3 ) =Q0 t I, j+3)+lP(i,K+6)*TP(J,K+6) 

07290 


70 

00( I, J ) = 00( T, J ) + TFU, KH‘TPU,K) *2500, «PE LTV DEL T 

07370 

C 


CONVERT UOPPR LEFT 3 BY 3 HF P MATRIX TP tULER SYMMETRIC 

07380 

c 


P^PAMETFR FGkM, original P ASSUMED DIAi 4AL . 

07390 



71=P(1* ] ) 

07400 



7?eD(?,p) 

07410 



Z3 = or», 3j 

07420 



0(1 » U = ,?‘ *( ZlvXl (4)*>i‘2 + Z2vXl (3)**2 + Z3*Xi(2) VV2) 

07430 



P{l,?)=P(?,l)=,25*{tZi-Z2)*Xl(4}vXl(3)-Z3*XiU)*Xll2n 

0744C 



=»(l»3) = P(3,l) = ,25*l IZ3-Z1 )vxH4»*Xl(2)-Z2*Ai(l)*Xll3)) 


07^50 

074c0 

07^70 

07bG0 

0761C 

0762G C 

0763C C 

076AC 

076b0 

07660 

07670 

07660 

07690 

07700 

07710 

07720 

07730 ^0 

077^0 
07750 C 
07760 
07770 C 
07760 
07790 
07600 

07810 50 

07820 C 

07630 

076AC 

07050 

07860 

0767C 

07860 IOC 

07690 

07900 

07910 

07920 

07930 C 

079^0 C 

07950 

07960 

07970 

079c0 


= >«2 + 22>» Xi ( 4 ) **2 + Z34'Xi (i ) 

(Z2-Z3)=«'>l{i)’!‘XilA)-il*Xi(2)>!‘Al(3) ) 
P(3, 3) = ,?5«(<.1<'X1 (Z)4‘«2 + Z2«XH 1)«*2 + Z3«X1 
0 = TI;PN 
ENO 


!:;j8oniiTTN;= ^1RCHK(T6L) 
rOM-MpM/l /MO,|'tDtLPji'lNl 

rnM*^ri‘'/?/TT--»fc, TO# I F, U£ L T# K Ofc 1 1 # X 1 ( 4 ) # X U ( ^ ) 

CnM»irK/5 / ’^SV(27#2)# PP (3 3y2) 

CnMMQKj/^/MTP, ICAl#Nu, YL (2#2) 

COMMnN/7/YO( 2»2), Y(2>2),U{15)#AST(3#3,2 >jSTP(3#2) 
niMEMSTPN TP{ -}),At3#3) 

T = 0 

CP=10. 

T = T + 1 

IF{T.or.3l GO TO 100 

FOCfl STAP I INfzKTIAL DIR. COS. 

CALL STAP0C(STR(1>1) jI#T 6L) 
priRM STAP DIR. COS. IN STA AXES 
nn <50 K = i»3 
U(K ) =0. 

00 50 J=1.3 

U(K)=^u^l^) + 8(^#J,l)♦STR(J#l) 

FHRM MFAS. PtSiDUAL 

PP=(Y{1,?J +uti)/0(2J )*«2+(Y(2,2) -U { 3 > /U { 2 ) ) *+2 

IHPP.GT.CP) GC, TC AO 

CP = PP 

TCaT=T 

GO TO AO 

rnsTTOl'F 

YLCl#l)=YLn#2)=Y{l,i)=YD(l#l)=YD(l#2)=Y(l#2) 
YL(2»l)=YLt2i2)=Y(2,il»YD(2#J ) = YO ( 2 » 2 ) = Y ( 2# 2 ) 
PETLJPN 
ENO 


SL'PPOUTTVP STARl-C (C> iSTk#T8L ) 

CnwMnM/2/TT^'t » T0#1 T#OEL l#KDLLT#Xl(i»)#XlL(A) 
rnMMON/5A<:sVl27#2)#PP{3)#B(3#3#2) 

OTVFM<:inM C C 3 )# Tp ( 3# 3) #KN( 3) #D ( 3 ) 



07990 C DPPIMF 5TAR DIK. COS. IN LAB(STA) AXES 

06000 TP(l>])=i, 

08010 TP(1»2) =TPfl . 3)=0. 

06020 TO(?,n = .oP«9902 

08030 TPt 2» 2)*2.42^E-6 

OeOAO TP{2»3) =A.Al956E-3 

06050 TP(3»1)=. 999^986 . _ 

08060 TP(3»P)=-?,AaAE-6 

' 08070 TP(3>3)=-1,'530A93E-3 

' .06060 CALL T^MS .... . 

08090 C FORN* NTRROR • OUTWARD NORMAL 

08100 C T9L=0 ASSUMES NORMAL ALONG X2 

06UO RN{l>=“SiN(.T0U - - ... - 

08120 RM(2)=Cns(TRU 

08130 R'^{3)=0, 

00140 C FORM TMPUT Tb STA IN LAB AXES USING_ REF L tCT. ION.. FORMU.L A . 

* 06150 Tl=RNm*TP( ISTR, 1)+RN{2)*TP( lSTRiZ)+RN (3)«TP tISTR# 3) 

08160 DO 10 T=lj3 

08170 10 D(l) = TP(rSTPiI )-2.*Tl*Rt!lLU ... . 

08180 C FORM LA3 I^fEKTlAL ATTITUDE 

06190 CALL LAPATT 

08200 C CONVERT TO TnERTIAL ..CO.DRD. 

'"08210 on ?0 T = i'»3 

06220 C(I>=0, 

08230 DO ?0 J = l,3 . . . .... 

08240 20 CIT) = C{T)+R{ 

06250 RETURN 

08260 END . .. 

08270 C 
08280 C 

08290 SUBRaUTTNE LAB ATT 

'08300 CnMMnM/?/TIME#T0jTF#DELT^KD£LT,Xl(4),XlL(4) 

06310 COMMnN/8/RSVC27j2)#PP{3)^B(3#3#2) 

: 06320 . . BTA = l.-CnS(,7,27220522E-,5=!<TIME) 

08330 P1=0. 

08340 P2*0. R?9930P41 

06350 P3=0. 557701P99 

C6360 AL=SIN(7.?7?2C522E-5*TIME) 

06370 ,-31A*(R2’S‘=i'2 + R3 + *2) 

08330 R{lt?5’)=AL*R3 + blA=f=Rl^P2 

08390 n n . 3# 2 ) =-A L ’fR2 + bTA«Rl4R3 

i 06400 P ( 2 . 1 . 2 )=-A L ^K3+iil A>('t<i>i‘R2 
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06410 
0C420 
06430 
06440 
084i>0 
06460 
08470 
06480 C 
08490 C 
066i?0 
08660 
08670 
08680 
08690 
06700 C 
06710 
087H0 C 
08730 
08740 C 
08760 
08760 
_ 08770 
08780 10 

08790 
08800 
06810 
08820 
_08830 
08840 

08880 20 
06860 
0 8870 
08860 C 
08890 C 
09220 
09230 C 
09240 C 
09260 
09260 
0927C 
09260 

09290 20 


R(2» .-tJTA*(Rl««2+R3»*2> 

P. (2» 3, ?) = At *Ki + bTA»K2=>k3 
R(3,l »?) = AL’l't<2+BTA«RH‘R3 
P( 3»?f 2 + 

P (3ji3> 2) = X,-BTA*(R1««2+R2«^2) 

return 

Fwn 


SURPnUTTNF GYpCk 

C0Mf*0M/1 /NG# MDELP, NMi 

CnMMnN/3/PI^»U(l^),TAU(3>6)^WH{6)^DRFT16),6y^9#6) 

CGMf<nM/4/pHTi{4,4>i?PHI2t4,3)^Ol7^7>»e014^6),WR{3,2).#RP(4ji4L 

PTMFNSIOM TP 13) 

PROVTDFS: ESTihATtD S/C RATES BASED UPON COMPENSATED GYROS, 
on 10 1=1,3 

SHIFT PREVIOUS RATE DATA BACK Qwi STEP 
WP{ 7,2)=WR( T,i) 

COMPUTE new gyro PACKAGE RATE ESTIMATE 
TP(I)=~PIMU( I) 
pn 10 J = 1,K'G 

TPIT)=TP(I)+IAU(I,J)«WM(J) . 

CONTINUE 
L = 3 

DO 20 1=1,3 . . . . 

WP(T,1)=TP(T ) 

DO PC J=l,3 

L=L+1 . 

WP { T,1 )=WR( T# 1)“P1MU(L)=«‘TP{ J > 

continue 

RETURN 

END 


SUBROUTIME ATI 

PERFORMS NUMERICAL iNlEGRATiON TO OEIERMINE SPACECRAFT ATTITUDE 
AS REPPFSFNTED BY EULER SYMMETRIC PARAMETERS 
C'"MMON/?/TINE,TC,Tf ,DELT,KDELT,X1{4 ),X1L14) 

CnMV/iK/4/puTil4, 4),PHl2t4,3),Q(7,7),Q0t4,6),WR(3,2)#RP(4,4) 
OIMFMST"*'! It 6) #TF (3) 
pn 20 T=T,3 

TP{ I ) = .8*(WP ( I » 1 )+WP tl»2 ) 1 



09300 C C'lnoUTF S(0) FOR USE IN RF fiATRiX 

09310 T(?) = {TP(1 )1=»2 + TP(2)*#i + TM3)<‘*2)«DELT«*2/4, 

09320 T(l) = ?CPT(T<2)) 

09330 T(2) = CnS(T(D) 

09340 T(3)=,5 

09350 TF{ABS{T(l)KLt.l,fc-20) GO TO 6 

09360 T(3) = SXNITU)} 

09370 T(3)=T(3)/{2.*T(1)) 

09380 6 CnNTTMUE 

, 09390. C, RP KATP IX. .FOR P.R,Q.P.AGA7IJtG EO,LE_R PARAMETERS - 

09400 RP(l»2)=T(3>«Tp(3)*DeLT 

09410 RP{I#3)*-T(3)«TP{2)*DELT 

J09420 RP(1»4)=T(3) >i'TP(l)*DELT 

09430 PP(?,? )=PP(1,4) 

09440 RP(2.4)=-RP( l.,3) 

0.94&0 RP(3^4)=PP(1,2J _ __ 

09460 00 10 T=i,4 

09470 RPdf I)=~T{2) 

_09ftep .. DO 10 J=1^T .. . „ „ 

09490 RP(T.J)=-PP( J>I) 

i 09500 10 CDMTTNUF 

09530 CALI PHT _ _ _ 

b>550 C PROPAGATE EULER PARAMETERS 

09560 DO 12 T=l,4 

1 09670 T(T)=0. 

: 09580 Pn 12 J=I>4 

09590 T(T)-T(I)+RP( I,J)=i^Xl{ J) 

^ 09600 12 CnNTINUF 

; 09610 C NORMALIZE FULER PARAMETERS 

! 09620 Tf5) » SQPT( T ( 1 )«*2+T ( 2 ) ««2+T ( 3 ) **2+T (4 ) «*2 ) 

09630 DO 14 T=l>4 

09640 X1(T)=T(T)/T(5) 

09650 14 CONTIMUF 

09660 RETURN _ 

09670 END 

09680 C 
09690 C 

097C0 SUPP^UTTNE pHI 

09710 C COMPUTET THE ;>TATE IRANSITIUN MATRICES PHil AND PhI2 

i 09720 CnMvnM/'i/N<;,|SjOfLP,(v;)vil 

09730 CnMMP'\;/?/TTM£,TG>TFjOELT»KDELT,Xl(4),XlL{ 4) 

09740 CnMMnN/4/PWTi{4,4),PHl2{4^3)j>0(7,7)>Q0(4j6)>wfR(3#2)j>RP{4,4) - 
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Q97i>0 

09760 

09770 

09780 

09790 

09800 

09810 

09620 

09630 

09640 

09850 

09660 

09880 

09890 

09900 

09910 

09920 

09930 

09940 

09950 

09960 

09.970 

09980' 

09990 

.10000 

10010 

10020 

10030 

10040 

10060 

10060 

10070 

10080 

10090 

10210 

10220 

10250 

1026C 

10270 

10280 

10290 

1030C 


Dir^FMSinfi W(4)#Tl(3#12)»PK(<i»3)>PHI2T(4*12) » T P i ( 7# 7 ) # T P2 ( 7, 7 ) 
nfMFN'STf’N '?n(7»7) 
ri>«PlJTF OHTl 
10 J=l,4 
U 1=1,4 
W(T)=0, 
on 11 K=l,4 

W( T)=w(I )+PP ( I,K}*PHI1(K, J) 
li CfiNTIMIlF 

no 10 T = 1 ,4 
PHIK T, J) =W( i) 

10 continue 

COMPUTE PHT2 . , 

nn 4P T=lt4 
00 ^2 J=l,NNi 
PMI?T( T, J)=0. 
on 42 K=l,4 

42 PHT?T(T, J)=PHI2T(I, J)+RP(I,K)*PHI2(K, J) 

00 14 T = l,3 . .. . 

P'<tI,T)=Xl(4) 

14 CONTINUE 

_PK(1,?)=-X1 (3) 

PK(1,3)=X1 (2) 

PK{?,3)=~X1(1 J 

P.K„(2,1 ) = X1(3 ) 

PK(3,1)=-X1 (2) 

PK(3,21=X1 n ) 

0K(4,1 )=-Xl ( 1) 

PK(4,2) = -Xit2) 

PK14,3)=-X1 (3) 
on 30 T=l»3 
nn 31 j=i,3 
31 T1(T,J)=0. 

30 Tl{T,n=-l. 

41=1 

on 19 J = 1,3 
no 22 1=1,4 
T7 = 0, 
m ?3 K = 1 , 3 

J7 s T7 + PK ( T, K)*l 1 (K, J ) 

23 CnNTT^'UE 

POT^(T,Jl) = PH12KI, JD+TZ 


10310 

22 

CnNTIMUE 

10320 


J1=J1+1 

10330 

19 

cpmttmue 

1035C C 


(iohatc C TF TIhE IS appropriate.. .. 

10360 


K0PLT=KPELT+1 

10370 


IF(KDFLT.LT. 100) GO TU 50 

10360 


KnPLT=C 

10390 


DP T = l,4 

10400 


DP 55 4=1 • 3 

.104x0 


TP3(T^ J)=0, 

10420 


no 55 K=l,3 • 

10430 

55 

TP?(I».n=TP2 (I^J)+PK( I, K)’!'C10(K^ J) 

10440. 


DO 60 T = l>4^ 

10450 


0'^ 60 J = l»4 

10460 


TPKI* J)=0. 

10470 


DP 60 K=l,3 

10400 

60 

TP1 f I» J)=TP1 ( I> JJ+TP2{i>K)*PK(a>K) 

10490 


00 61 T=5»7 

10500 


on 61 J=l»4 

10510 

61 

TP1(T» J1=TP1U# 1)=0. 

10520 


DO 62 T=5,7 

10530 


DP 62 J=5>7 

10540 

'62 

fpi(T^ J)=Q0(I-4>J“1) 

10550 


TQ=RP(2# 1 )**2 + RP{3>l)**2+RPC4#l)*’i‘2 

10560 


TO=S0RT(l.-l0000,*T9) 

10570 


DP 63 T=l>4 

10580 


nn 64 4=1,4 

10590 


R0{I,4)=PP(T> J)*100. 

10600 

64 

P0( T+3,J)=0. 

10610 


00 65 J=l>3 

10620 


R0(T, J+4)*-0EL17PK{I, J)*50. 

10630 

65 

P0( T+3, J+4)=0. 

10640 


P0( I+3,T+3)=1. 

1065C 


RP(I»n=T9 

10660 

63 

CONTINUE 

10670 


no 66 T=l,7 

10600 


nn 66 4=1,7 

1C690 


TP2(T, J)=0, 

10700 


no 66 K=T,7 

1C710 

6b 

T'i?{T,J)=TP5>(l,J)+0(l,K)7RC(J,K) 

10720 


nn 67 T=l,7 

10730 


DO 67 J=l,7 


10740 0(I»JJ=TP1 (T^ J) 

107b0 nn A? Ksi,7 

107t0 67 0{T>J)=0f t, J J+RC(1>K)^TP2{K,J) 

I 10770 !>C CnNiTimi'^ 

I 10760 C PWT? f/iu<?T STILL bE MULTIPLIED BY OELl/2 IN PKFIL 

10790 PPTUPN 

I 10800 END 

I 10810 C 

10820 C 

i 10830 Sll4PnUTTNP OMM 

10840 C FPPM THE STATE NOISE COVARIANCE MATRIX 

1085C CnMMON/I/Nn,NOELP>NNl 

10 860 C0MMDN/A/PHU{4j4),PriI2(4# 3 J,Q(7>7)?Q0(4>6),WR(3?2J,RP{4,4) 

I 10670 DIMPN^'intJ TPi(7j7) 

10880 C PPnPFRLY PACK Q MATRIX 

I 10890 OQ 10 T*1j7 

i 10900 nn 10 Jsli? 

I 10910 10 TPKT, J)=0(T, J) 

! 10920 J3»3 

1 10930 on 15 I=i,3 

i 10940 Jl=3 

I 10960 _ DO 17 J=l,3 

I io97o ji*'ji+r ' 

! 10980 0(I.JU=0U1,I) = TP1(I, J + 4) 

10990 17 CONTINUE 

liOlO J?=J3+1 

11020 J2=3 

11030 nn ify j = i,3 

j 11050 J?«J2+1 

i 11060 OC J3» J2)=TP1( 1+4* J+4) 

I 11070 16 CONTTNUF 

I 11080 15 CONTINUE 

11160 RETURN 

^ 11170 ENO 

1 11180 C 

! 11190 C 

1120C SUPPOUTINE TRAC 

< 11210 C rnNOiJTFS TPACKtR OUTPUT ANGLES FROM ATTITUDE AND 

11220 C TOACKFP THFMI XFICATIJN NUMBER 

11230 CnM»anN/7/TTMt*T0>Tf ,ulLT,KDELT,X1(4),X1L{4) 

11240 CnNw^N/5/SSV(27#2)*PP(3)*B{3*3*2) 

11250 rOMMON/A/NTP, 1CAT*N0#YL(2*2) 
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U260 
11270 
11260 
11290 
1130C 
11^00 C 
11^10 
11^20 
11430 
11440 
11460 
11460 
11470 C 
1146C 
1149C 
11500 
11620 
11630 
11640 
1165C 
11660 
11620 C 
11830 
11840 
11850 
11860 
11870 C 
11880 
11890 
11900 
11910 C 
11920 C 
11930 
11940 
11950 
11960 
11970 
Il9a0 
1199C C 
12000 
12010 
12020 


rQMMPM/7/YO ,Y(2^2)jU(15), AST(3j3>ii)i STk(3,<;} 

T{6)^C (3#3) ,17 (3) 

YL (l,l)=Y(l»i) 

YL(2tl)=Y{2,l) 

CALt TPMf 

CHMPUTP TpACM'H TKANSFCRMATIDN RELATIVb TO ECl 
m 80 I=l»3 
PO J = l.^ 
rcT, j)=o, 
nn no K=!,3 

Cfr»J) =C(I,.J)+AST(l,K,f'iO)«8(K>J,l) 

80 CnNTINtJP 

CnyiPMTE STAR DIRECTION COSINES IN TRACKER AXES 
DO 90 T=l»3 

U(T) = r(r,li*STP,(l,i)+C(J,2)*STR{2,l)+C(I,3H'STR(3,l} 

90 CnivlTIMUP 

Ut4)=U(l)/U(2) 

U{5>=U(3)/U(2) 

U(6)=U{4)«U( 5) 

IH71=U(4)««2 
U(«)=U(5 J 

C*^MPUTF TRACKER OUTPUT IF II HAD INFINITE BANDWIDTH {INTERVAL AVE,} 
Y(I,1 ) = (-L'{4)+ U{6)*SSV(1,N0) +U( 5 )*SSV{ 2,N0) 

l-fl.+U{73 )’S^SSV(3,N0n 

Y(2»l ) = (1J(5J -(1. +U(8) )*SSV(1, NO) )+U(4)+SSV(2,N0J 

H-U(6)«SSV(3,N0) 

I'JCLUD'^ TOAC^ER DYNAMIC EFFECTS (HI Brt TRACKER) 

Y{1,1 ) =^y(l,i )-SSV( 22 ,60) *7.272205£-5 

100 RPTUPN 
FNO 


SUPPnilTT'''F TRCFLI 

CnMvnN/?/TT’<£, T0,7F,ijELT,KDbLT,Xl(4),XlL(4) 
CnM«0N/';/SSV(27, 2),PP(3),B(3,3,2) 

COMunM/F/NTP, ICAT,NO, YL (2,2) 

roKvynN/7/Yn(2, 2) , YU,2 ),U{15),AST(3,3,2),STR(3,2) 

0TMF»''5I'iv CU),R12) 

ponv^nrc cii 7{_PbO TkACkEP. Ll.-TPUT 

r (1 )=s^v(^e.NO)/DbLT 

r(')=SSVf?7.NG)/DELT 

p n ) = cyo(-i . /c a ) ) 
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12030 
12040 
12050 
12060 
12070 
12080 
12090 
12100 C 
12110 C 
12120 
12130 C 
12140 C 
12150 
12160 
12170 
12160 
12190 
12200 
12210 
12220 
12230 
12240 

T2250 

12260 

1227C 

122~0O 

12290 

J230P 
12310 
12320 
12330 
12340 
12350 
12.360 
12370 C 
12380 C 
12390 
12400 C 
12410 
12420 
12430 
12440 


R{ 2 ) = «::xpt-i.yC( 2 n 

m 10 v=i,2 
on 10 T=l»2 

10 YO ( I , K ) = yr* ( T , K ) «R ( u+ ( 1 . -C. ( L) ♦LI. . “R ( .1 1 j ) *7 U ^ K ) 
1 + (C (D + d .-P (X) )-*R(in+YL{Ijk) 

PFTURM 

END . 


SUgPnUTTNE PRFIL_ __ 

CDhiVFRTS 4 -paRAMETER ATTITUDE SYSfEK TO 3 PARAMETERS AND MODIFIES 
STATE TRANSITION MATRIX 

CnMMnN/.l/NGjN.OELPANNl . - 

CnMNnN/?/TTME,TOj TF,DELT^KDELT,X1(4)# X1L(4) 

COMMDN/B/PTMudZ)^ TAU(3j6)> WM(6) ,DRFT(6),GY(9#6) 

C0MMnN/4/P^HJl(4, 41/PHI2 (4, 31iLQ.(7#7d Q0t4»6).,WRt3t2>#.RP(4, 4). 

C0MNbN/5/SSV(27,2}^ PP{ 3)j 8(3# 3,2) 

COMMnM/6/NTP, ICAT,N0,Y1{2,2) 

CnMM0N/7/Vn(2,2},Y{2,2),U(15},AST(3,3,2),5TR<3,2) 

CnMNON /P/P ( 7, 7 ) > R (2, 2 ) , AK ( e, 2 ) , HMAT {2,7) 

OTMFNSTDN W(3) 

W{l) = XlUlJ_/XiLL4) „ 

W{2)=XlL(2)/XlLtV) 

WC3)=X1L(3)/X1L(4) 

on 10 1=1,3 . .. . . 

on 10 j=i.3 

PHIin, J)=PHIl(I,j)-PHIl(I,4)=S=W(J) 

10 CONTINUE . . ... 

bo 12 1=1,3 
on .12 J=1,NM1 

PHI2(T, J)=PHI2(I, J)«0ELT/2. 

12 C^NTTNUE 
RETURN 

end ... 


SUBROUTINE HM7RX 
COMPUirs MEASUREMENT MATRIX 
rnMM.TN/l/NG, ND£LP,NN1 

CnMNnw/?/TIWt,T0»IF,JELT,K0£LT,Xi(4),XlL(4) 
common / 6 /MJP, iC AT, NO, YL (2,2) 

CnMMnM/7/Yn(2,2),Yl2,2),U{ 15 ) , AST {3, 3, 2 ) , STR { 3, 2 ) 

A-24 


l apfe; 




12450 


COMMON / P /P ( 7j 7 ) ^ R { 2 ) ^ AK{ 6> 2 ) , HKAT ( 2^ 7 ) 

12460 


DTMCM<?inN T(3), 1 t {A^-^)>T1(2/A) 

1247G 


OTMCMSTP''! TA(2,A) 

12780 


nn 130 

12790 


TT{ T, T)=n, 

12800 

130 

rONTTMUF 

12610 


TT(l?2) = ~?TR(3#1) 

12620 


TT(1^31 = STR(2j1) 

12830 


TT(1,A) = STR(1,1) 

128'tO 


TT(^,^) = -SritUi-lJ 

12850 


TT(2,i^) = STk{2#l) 

12860 


TTC3»^) = STR(3,1J 

128.70 


TT(2»1) = “TT{1»2> 

12880 


TT(3>1 ) = -TT d>3} 

12690 


TT(3»?) = -TT(2,3) 

12900 


TT(A,1 ) = TT(1^43_ „ .. . 

12910 


TT(A»2J = tT(2#4) 

12920 


TT(4»3) = TT(3^4) 

.12730 


rn ) = -X1(1)/X1JA) 

12940 


7(2) = -Xl(2)/Xl(A) 

12950 


7(3) = -X1(3)/X1(4) 

12960 


OP 160 T=l»3 

12970 


on 160 J=l>3 

12900 


77(T>J) = 77(I> J) + STR(I>l)>i‘T{J) 

, 12990 

160 

roN7INUE 

13000 


m 165 I=l»3 

13010 


71(1,1) = (~AS7a,l^N0)*Xl(A)+AS7{I^2,hU)«Xl(3) 

13020 


1-AS7(T#3^M0) «X1(2) )*i<2. 

13030 


71(1,2) = (-AS7(I,l,NO)4'Xl(3)-AS7a,2,NO)’*‘Xl{A) 

13040 


1+AS7( T,3,N0) *X1(1 ) )*2, 

13050 


71(1,3) = (AS7(I,1,N0) 4X1(2 )-AS7(I,2,N0)»Xl(l) 

13060 


1-AS7{ T,?,Mn)#XI (4) )«2. 

13070 


71(T,4) = (-AST{I,l,i^C)*Xl(l)-AS7tI,2,Mj)«Xl(2) 

13080 


1-A'J7(T»3,M0)+X1(3) )*2. 

13090 

165 

CnN7TMlJF 

13100 


np 166 K=l,6 

13110 


7A (1,K)=71 ( 1,K) /U(2)~71 (2,K )«U( 1) /U(2)f‘>!‘2 

13120 


7A (?.K )=T1 (2,K)*U(3) /U(2)>i^*2-Tl( 3,K) /U( 2) 

13130 

266 


13140 


on ICO J=l,3 

13150 


H*-1A7(1 . J)=n. 

13160 


M*^A7( 2, J) =o. 
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13170 

13160 

1319C 

132C0 

1321C 

13220 

13230 C 

13240 C 

13250 

13260 C 

1327C 

13260 

13290 

13300 

13310 

13320 

13330 

13340 

13350 C 

13360 C 

13370 

13360 C 

13390 C 

13400 

13410 

1342C 

13430 

13440 

13450 

13460 C 

13465 

13470 

13480 

134<0 

13500 

13510 

13520 

13530 

13540 

13550 

13560 

13570 


pn K = l,* 

H''4Tn . + rA( 1#K)*TT(K# J) 

HWAT(’, (2# jUTA(2»I< )>«'TT(K# J) 

XfaC 

PFTUPN 

5MD 


SU6''nUTTNF PllAT 

FHRM5 MFA^llPthENT NOISE CLVARIANCE hAT.RlX 
nMH0N/5/SSVl27,2)/EP(3)#B(3>3^2) 

CnMMnN/f /NTP^ ICAT,N0>YLI2 j2) 

/ o / O ( 7, 7 J , fi ( 2, 2 ) , aK t 8? 2 ) » HKAT ( 2» 7 I 

■’(1,?)=d(2,1)=0. 

PClrl)=SSVt?4,NG)442 
P(2>?) =SS'/(?5jhC)4’J'2 
PFTUPM 
FMO 


SlJ4P'^UTI^'F FUT 

USING KALNAN FILTER^ tuS.j CGHPUTES FILTER GAINS, AK, AND PROPAGATES 

FPROP CnVARIANCE KATRIXjP 

CONwnN/l/NP,NDELP,NKl 

C0MNnN/3/PTHU(12),TAU(3,6),l«iM{6),DRFT(6),GY (9,6) 

CnNMnM/A/PHIi (‘>,4 ),PH12(4,3) ,Q(7,7),Q0(4, 6) , WR ( 3, 2 ) , RP ( 4, 4 ) 
CnMMnN/5/SSVl27,2),PP(3),B(3,3,2) 

CnMMpN/P/P(7,7),R{2,2), AK( 6,2),HNAT(2,7) 

OINENST^N TA (7,7),TB(7) 

COMPUTE ADOITiONAL CONSTANTS FUR PARTIIIONING MATRICES 

NN2=NN1 

NN3=NN1-NN2 

MsNK'1+4 

Ms? 

CALL SPWMUl (PhI 1,1, 1,3,3, P,l, 1, 3,TA, 1, 1, 4, 7, 7 ) 

CALI SPMMUL f PHl2,l,l,3,NN2,P,4,l,3,P,i,l,4, 7,7) 

CALL SPNAODH A,1,1,P»1, 1,1 A, 1, 1, 3, 3,7, 7, 7 ) 

CALL SOmmui, ( eHll,x, 1,3, 3,P, 1»4,NK2, TA, 1,4, 4, 7, 7) 

CMl (rHl2,l,l,3,NN2,P,^,4,NN2,P,l,4,4,7,7) 

CALL SPMAnD{lA,i,4,P,l,4,P,l,4,3,NN2,7, 7,7) 

CALI ( Prill, 1, 1, 3, 3, P, 1, 4 + NN2, NN3, T A, i , 4+NN2, 4 , 7, 7 ) 

CALL SPVMiJLt PhI2, 1, 1, 3,NN2, P,4,4+NN2,NN3, P,1,4+NN2,4,7,7) 


13500 

135<iO 

1360C 

13610 

13620 

13630 

13640 

1365C 

13660 

13670 

13660 

13690 

1370C 

13710 

13720 

13730 C 

13740 

13750 

13760 

13770 

137b0 

13790 

13600 

13810 C 

13820 

1363C 

1384C 

13850 

13860 

13870 C 

13880 

13890 

13900 C 

13910 

13920 

13930 

13940 

1395C 

13960 

1397C 

1396G 

13 990 


X1 = A + ^.'M? 

r/vLL SPMADPt rA,l/il,P,l,Il,p,l,Il,3,N>J3,7/7W) 
P'’ 15 T = l»3 
PT 15 K=2,3 
t»(I,K)=0, 

DO 15 J=l»3 

15 P(I»K)=r(T#K )+TA(l, J)*PHI1(K> J) 

20 T=l»3 
DO 20 K=l»3 
TA(T^K)=''. 

00 20 J*1,NN2 

20 TA( I,K)=TA( T,K)+P(I^ J+3)*PHI2{K* J) 

CALL SPMAPPCP,1,1,TA,1,1#P/I^.i^3«.3,7.,7,7) 

CALL SPMTPA{pjl>4,3#isN2j P,4*l»7#7) 

CALL SRMTRA ( p,iJ^ + NU^>3»^(^t3^ P^4thN2, If 7,7) 
p=puT o owt-TRANSPGSE HAS BEEN CUMPbTED 
CALL SPMAOD( P,l>l>Q>i,ljPf 1,1, 7,7,7) 

RETURN 
PNTPY FFILT 

CALI SP'^NUL (hHAT, i,i,H,N»P,l, I, N, TAf 1, 1, 2 , 7, 7 } 

CALL SP^^TPACHhAlflf l,tt,N,AK,l,l,2,8) 

call SPrWUL nA,l,l,H,N,AK,i,l,M,TA,M + l,l,7-r 8,7) 

CALL SRr'APDnA,M+l,i,R,l,l,TA,l,l,H,M,7,2i7) 

rMVEPSF ROUTINE FOLLOWS 

DET=TA (1,1 )*TA( 2,2 )-TA 12,1 )«TA (1,2) 

TA(1fM+l)=TA(2f2)/DET 

TA(1ft« + 7)=-TA(l,2)/DEl 

TA(?f*^ + l )=-TA(2,l) /DET 

TA(?fM+?)=TA(l,iJ/DEI 

END OF INVERSE t'JDUTINE 

CALL SPMPUU AK,1,1,N,N,TA,1,M+1,P„TA,1,1,8, 7,7) 
CALL ?RMMu 1 f p,l,lfN,N,TA,l,l,M,AK,l,l,7,7,8) 

AK HAS PFEN COMPUTED 
Pn T-lfH 

DO 45 «=1 fM 
TA ( T»K)=n. 

P'7 4C J=lfM 

40 TACTt^) = TA(I,h)-AK(l,J)*HMAT(J,K) 

T<^ (I.N'C.j^) bL- TU 43 
TA(T,V» = 1 .+TA( l,K) 

45 CnNITNUr 

nn 55 T=lf^: 
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I<r000 

14010 

14020 

14030 

14040 

lAObO 

14060 C 

1A070 

lAoeo 

14090 

lAlOO C 

14110 

14120 

14130 C 

14140 C 

14160 

14160 

14170 C 

14180 

14190 

14200 

14210 

14220 

14230 

1424.0 

14250 

14260 

14270 

14280 

14290 

14300 

14310 

14320 

14330 

14340 

14350 

14360 

14370 C 

14380 C 

14390 

14400 C 

14410 


m 5C K=1»M 
TR(K)=0. 
on 50 Ja1 , M 

50 Tn(K)=TR(K) + TA(I#o)^V( J#K) 
m 55 K=1,M 
55 T<‘(T»K)=TB(K ) 

5JYMWFTPT7F FkftOR COVARlANCt: MATRIX 
on ^,0 T = 1»M 
nn 60 J=l»N 

60 D(r,.n=0.5*{TA(l#d)+TA(o,I) ) 

P(K+1) HAS PcEN COMPUTED 
RETURN 

FN9 . 


SURPTIITINF SRMMLK A, I MA , INA^ M A^ MA, IMB^ INfipNB#C# IMC^ INC> IRA, IRB, 
ITPC) 

C = A=tR k'TTH TNIT. ARRAY ELEMENTS SPECIFIED 
DIMFMSinH A(49), B{49)>C (49) 
pn 5 T = '',*^A 

IPIN'C = I + T«C 

= T + T»^A 

IF (NP.lT.l > GO TG 6 

nn 5 

K°IMr = K+TNC 
KPINP = K+INtt 

TC = TRTRC-I +(KP1NC~21+IRC 
C(IC!I =0. 

IF (MA.LT.l) GO TC 6 
no 5 0=I,NA 
JPINA = J+TMA 
joi^n = J+TMB 

TA = TPTMA-l+( JP1NA-2)#IRA 
IP = JPIM«-1 + (kHNB-2)’«‘IFB 

5 C(TC) = CdCj + AClAj’i^tillB) 

6 RFTUPN 
FMO 


•JlJRPnjiTIi'jE SrsNALO (A, IMA, INA,fl, 1MB, INB»C, lkv» INC,h>N, IRA, IRE, IRC J 
r=A+P WITH TUIT* ARRAY ELEMENTS SPECIFIED 

DTWPMSIP»- A(<,V),B{49),C (49) ^ 
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14^2C 

l<f430 

1^^60 

14480 

14490 

145CC 

14i>10 

14520 

14530 

14540 

1455C 

14560 

14570 C 

14580 C 

14590 

14600 

14610 C 

14620 

14630 

14640 

14650 

14660 

1^670 

14680 

14690 

14700 

14710 

1^720 

i<*730 

14740 C 

14750 C 

14760 

14770 C 

14780 C 

1479G 

l^dOC 

14 81C 

14820 

14830 


f>n 5 1 = 1, 'I 
TP (W. ! T. 1 ) uu Tu 6 
r>n 5 j=i,M 
yoTMr = t + T’^'C 
JoiNr = J+TNC 
JPTMA = I + 

JPTNA = ,1 + INA 
TPIMH s T+T^B 
Jpr^'4 = J + INJC, 

lA = IPTMA-1 4 { JPINA-2)*1RA 
TP = TPTMR-I + ( JHlr'iB--2)*lRa 
TC = IPT''C-1 + UP1NC-2)«IRC 

5 CfTC) = AtIA)+B( 18) 

6 PPTUPN 
FMH 


SUBRnUTTMF ?R( 1 TRA( A, IHA, 1NA>H>N^ B, IMB, INB^ IRA> IRB) 
DTMFNSTON A { 49J > B ( 49.) 

B = A-TP ANSPOSc iNlTh INIT. ARPAV ELEMEKT 8 SPECIFIED 

TC {N.LT. 1 ) GO ID 6 

on 5 T=1 , N _ 

nn 8 J=1,M 

TPTMB = I+TM6 

JPINP = J+TNB 

JPTMA = J+TRA 

TPTNA = T+T^A 

TA = Jptma-i+( ipinA“2)*IRA 
in = IPI!^B-l + ( JPU'B“2)*1R8 

5 B(IP)=A{TA) 

6 PFTIJPN 

FMO 


SDBRm'TTMC PGFU 

UE»nATrs ATTIIUDE VARIABLES AND OTHER SYSTEM tLEMEMS QF THE 

STATc VECTOP 

rnMvn,^,/^ huELF, NM 

C'”^^"'’'t/P/TT''c,a,lF,Ot:LT,KDELT,Xi(*t),XlL(‘») 

QnN,v-th /5/oT**t,ii2),TAu(i,6),wf'{o),DRFT(6),GY(9,6) 

r M wn /7/Yri(i:, 2 ), t<2,?),U (15), 4SI13, 3, 2), S IK (3, 2) 
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i^e^C f'‘^M«nN/P/n(7#7)>k(2*ii)>AK( Cj 2 )»HhAT (2^ 7 ) 

i«te:>0 nt'^cv^THKj W(iiJ,T(a) 

l<»8oO Wf 1 ) sYOd. 2 )-YOt i, 1 ) 

1A870 w{2) = YnC2i ^ 1 “YDtii i ) 

14900 C CQMPUTP C'"‘?^cC7lU^ tuR EACh SYSTEM PARAflETER DR STATE VECTOR 

14910 nn 17 T=1»MN1 

14920 W(3) = AK{T+i>lJ*w(lJ+AK(I+3^2)#k(2) 

15020 PTMU{I) = nif'Uin+rt(3) 

15060 11 rONITINUJP 

1508C C C^^PUTF r?c3tCTILNS ELR EACH ATTITUOE VARIABLE 

15090 00 o T = d3 

15100 T{T) = AKdi id=V.(l)+AK(d2)*h(2) 

15110 9 ChniTNUE 

15120 C UPOATF ATTTTuoE VARIABLE:! 

15130 yi{4)*yi(4)-lXl(l)*TU)+Xl(2)<‘T(2) + Xl{3)*TC3))/Xl{4) 

15140 0'^ TO I = T,3 . . 

15150 XI m=xi{ n + T (I) 

151o0 10 Cf'WTTMUF 

15170 PFTUPN 

15180 FNO 

15190 C 

152CC C _ , . . _ . . . . 



APPENDIX B 

DATA ANALYSIS PROGRAM LISTING FOR THE 
GIMBAL SYSTEM TEST 


CiM Cjp8^ C«*»i 




OOIGC 
OOllC 
00120 
00130 
001^0 
OOlisO 
00160 
00170 
00180 
00190 
00192 C 
00194 C 
00200 

00203 C 

00204 C 

00205 

00206 
00210 
00212 
00220 C 
00230 
00240 
00250 

00255 

00256 
00260 C 
00200 
0C310 
00320 C 
00330 C 
00340 
00350 C 
00360 
00370 
00375 
00380 
00390 
00400 C 
0041C C 
00420 
00440 
00460 


PADSaNPUl>GuTF0t#TAPEl^TAPc2»TAPt4jTAP£5) 

/Nf;, NDELP^NNi 

CGMPOM/P/TTP ti TO,TF> DELTjKDELT»Xl(4), XlU4)i.K:,« P 

CnMMnM/4/PHTi{4^4}>FriI2(4,3)>0(7, 7)^00 (4f6>^WR( 3#2)#P.P{ 4,4) 
CnM^I0N/5/f?SV<27#2),PP{3),B(3i3,2) 

CnMMDM/6/NTP, 1CAT,N0,YL (2,2) 

CnM*^nw/7/Yr'( c,2), Y( 2,2) >U( 15), AST (3,3,2 ) , STR{3,2) 

CnrtMrN/'»/P (7, 7},fi U,2),AK(6,2),Hf':AT(2,7) 
n.T»^EK'5;TPM GYDA1 (500, 14), GXi(14J, 0X2(14), MSTR(20) 

KTYP=0 - PEAL LAB JKTYP=1 - GYROS REORIENTED? 

KTYP-P - inFAL GYROS 

DATA KTYP/0/ . _ , 

MFTP(I) nPN'^TES WHETHER THE I TH VISIBLE STAR WILL BE USED 
FOR PTITFRING? IF SO, HSTR(I)=1 

DATA (M?TP(I),.I = i,.171/ljl,l,lj-..l,l,.l^l,.ljUi,l>.i,l>.l,i,.17 

5 F0RMAT(X,7HKTYP = ,11/) 

X CONTTNUF 
N7«3 

PPWTND TAPES 
REWIND 1 
pcwif^n 2 
REWIND 4 ' 

REWIND 5 
WPTTE(2,5) KTYP 

ppcrriTVELY ELIHINATE THE FIRST DATA LINE 
RPAD(4,2) (RYOAT(l,0), J=l,14) 
nk;i = 3 

RFAO TN AND PRINT OUT I NITI AL ' VALUE S, SYSTEM PARAMETERS AND RUN 
CONTROL CONSTANTS 
CALL INPUT 

TNTTIHT7E CjUNTtRS AND FLAGS 

NXC=I<PP=HF = 0 

jrY=50D 

^^T = FKF=0 

NO=T 

PEAD(4,2} (PaK J), J = i,l4) 

OF UlILR LOUP 

INTTIALTZC STATE IKArolTICN MATRICES Prill AND PHl? 

IS nWTTNIJF 
CALt 7FDn 
20 COMTTNtjF 
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00490 

OOiiCO 

OOblO 

0C520 

00330 

Q0540 

00530 

00560 

00570 

00560 

00590 

00592 

00600 

00610 

00620 

00622 

00623 

00624 

00625 

00626 
00630 
00640 
00650 
00660 
00670 
00660 
00690 
00700 

00710 

00711 
0072G 
00730 
00740 
UC750 
00760 
00770 
00890 
0090C 
00910 
00920 
00930 
00940 



T''OFX> THF^M TfcST »-0R wriE fhLR Nfcw FLIGHT GYRO DATA SHOULD BE READ 
TPy = T'‘-Y4T 

T^'Y.LF .500) Gu TO 23 
TOY-1 

on ?4 T*1 » 5P0 

PPAD(4>?) (0X2( J=1>14) 

PLT*:GX?(1 )-6Xl{l) 

GYr)AT(T,l)=PXl(l) 
on 17 K=?,4 

17 GY0AT(T,K)=(gX2(K)-GX1(K) ) /DLT*4, 6481366E-6 

IF (KTYP.EQ.C) GU TO 25 
IFTKTYP.PO.l) GO TO 26 
GYnflT( T» 2) =r4, 66164026 E-5 
6YDAT( T> 3) =-4.494967006-5 
GYOAt( T»4>=4.575127c0E-5 
GO TO ?5 
26 CnNTTNlJF 

GYDAT(I>2)=GYDAT(I#2)+4.26794675E-5 
GYOAT ( Tj» 3 ) =GVOAT ( 1/3 ) +2 , 115715 8BE-6 
6Y0AT(T/4)=6YDAT (l/4)+1.97941334E-5 

23 rONTTMUF 
...in IP K = 5»14 . 

18 GYDAT(I#K)=Gxi{K) 

DO 19 K=l/14 
19 GX1(K)=GX2(K.) 

JP( Pf!P,4) ?3^24 

24 CONTTNUE 

FORMAT 2 TS 6ELSKYS TAPE FORMAT 
2 F0RMATlx,F10.3/3lF12.1)/F3jX/Fll.i/ X/2tF7.1/X)/2{Fll,l/X)/ 

14{F5.1/X)) 

FORM TIME and INTEGRATION STEP 
23 mNTlNltF 

nELT=GYnAT(^GY,l)-TlME 
TTMF=OVnAT{ TGY/1) 

on 33 T = 3 »N0 . 

33 WM(T)=GYn4T( IGY/ I+l) 

TEST FOP EMO OF PUN 
TF(TTmF.LT.TF) GU Tu 43 
STOP 

A3 rONTIMUP 

Any/ANTF state PRIM CUUNTEP 
lNJXC-MXr + l 
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^>W B fe j 


0C9b0 C 
00960 
00970 C 
00960 
00990 C 
01000 
01010 
01020 C 
0103C 
01060 C 
01070 
01140 
01150 C 
01160 
01170 
01100 
01190 
01230 C 
01240 
01250 
01255 
P12e>0 
01300 
01305 
01310 
01312 
01320 
01330 
01340 
01350 
01360 
01362 C 
01364 
01370 
01380 
01450 
01460 
01470 
01460 
C1462 
01490 C 
01520 


f'^MPSJTE HSTTrtATEu SPACECRAFT BODY ANGULAR RATES 
CALL GYPCK 

c'^'iPtiTF fsttnated spacecraft attitude 

CALL ATT 

TIME TP PPIN7 STATE 
IFCNXC.LT.NPELP) 44,81 

61 CnMTINUr 

FHpv C5TTWATEJ spacecraft ATTITUDE DIRECTION COSINE MATRIX 
CALL TOWS 

OPTKT fsTIMATED S I ate . 

CALL XlpPMT 
NYC = 0 

IP KPP = 1,TH.I.S PRINT FOUk.DVve.D. A.. FILTER. DPERA.TIQN 

TFLKPP.FO.l) 46,44 
48 KPP=0 

60 TO 15 ... - 

44 CONTTNUF 

TFST IF TRACKER DATA IS PRESENT 

IF(GYDAT(IGY,5) .GT.0.5J. 60>52. 

52 MFa-KSKP 
KKp = 0 


60 TD.20 , . .. 

60 CONTTNUF 

IFtKKF.EQ.l) GO TO 20 
IP(G.YDAT(IGY,5) ,GT.1,5) GO TO 601 . 
WT=^*T + 1 


DVl=GYPATt I6Y,13 J 

OVP = GYnAT(TRY, 14) 

601 CPNTTNUF 
NF=NF+1 

IF{NF.LT.1) go TO 20 

TEST WMFTHFP THIS STAR IS ACCEPTABLE 
TFfMSTRlMTl.i'.E.l) Uu TD 52 
TO^GYPATt TFY, 7)+DV2 
TV=GYnAT(TRY,8J+DVl 
YHl,?l=Ytl,2) 

YL(2tP)=Y(?,2) 

V(l,7) TIJY4. 64ci3bClE-6 


Yf2,2) - TV*4 , 64 fcl3ojlE-e 

YG=: CYnATtT'''Y,6)=f'4. 046136611 -6 

ATP RPARTWG lABLt. ANGLE CCMfUIATIUN 


T«L= GYrAT( T^,Y,9)^4.■J4fcl36PiE~6 
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01i)30 IP{MF.rQ.l) 62#61 

0154G fc2 CALL 

01650 61 nMTIf^IlP 

01560 C CPHPiJTF TWFP11AL STAR 0 IR . COS. 

0157C CALI. STAROC I STktl>l)» ICaT,TBL) 

01560 C CDMPUTP EST, TRACKER OUTPUT 

01590 CALL TRAC(YC) . . .. 

01600 CALL TPrPLT 

01610 IFLNP.LT.IO] 60 TL 20 

01615 KkF*=l 

01620 C START FTLTFR1S6 

01630 C COMPUTE TRACKER M6ASURMENT RESIDUAL NORM 

01690 . Wl-SOPTl (YDCi#2>-YD(l>l>)*«2+CY0(2>2)-YDt2^1) )+*2) 

01650 C DOES IT FALL WITHIM AN ALLOWABLE ERROR 

01660 TF(W1.LT..1> GO Tb 70 

01670 72 PPTNT 3,V!1 

01680 3 FnpMAT(20HMEASUkELEHT ERROR I Sj 2X# E13 , 6, 6H> PUNT) 

01690 STOP 

01700 70 CONTTNUF 

01701 ' X0P=0. 

01705 WPITF(5fA) TlMLj Wl> X09j N7 

01706 9 FnRMATt3(_2X, E13.fa),2X,Il) 

0X710 CALL XIPPNt' 

01720 NF=-KSKP 

01730 C PnR*fl STATP_N0ISE ERROR COVARIANCE . NATR„1X 

01790 CALL Q^'AT 

01750 C AITFR STATF transition MATRIX TO DEAL WITH 3 RATHER THAN 9 

01760 C ATTTTb.lF VAPJABLES 

01770 CALL PPFTL 

01780 C PROPAGATE STATE ERROk COVARIANCE MATRIX 

01790 CALL FILT. 

01795 CALL PPNTn) 

01000 C Pf?PM MPASUPPENT MATRIX 

01610 call wMTPX 

01820 C FORM MEASUREMENT NOISE COVARIANCE MATRIX 

01830 CALL PMAT 

01890 C APPLY KALMAN ALGORITHM 

01650 CALL FFTLT 

01060 C UPDATE STATF 

01870 CALL POPIL 

01080 C ADVANCP FILTER CCiUNIEP 

01890 NP^'aNPC + l 





bwaad kmmd iawEf USB C^Pfel t**«3 6««5 E---*! 0---.) 


1 


01900 C TT^1E TP PI?INT STATE ERROR CUVARIAnCE MATRIX 

01910 TP(wpC-hfp) i5,fcO,eo 

01920 tC CnNTI''‘UP 
01930 CALL PPHTCl) 

019A0 KPP=1 

01950 0*^ TO 31 

01960 ENP 

01970 C 
r 01980 C 

_01990 . S'BPnuTTNF Tk.NS,,.,_ .. 

02000 C COMPUTE ofPECTIuN COSINES OF SPACECRAFT ATTITUDE RELAfiVE TO 

02010 C ATTTTUPF PEFERENCfc AXES(ECI COORDINATES) 

02020 C*^MMnRV2/TTMEj TQATF>i)£LTAKpEJ-Tj!XliA)i>„Xl.LJ4). . .. . 

02030 COMMON /5/SSV ( 27# 2 ) , P P 1 3 ) # B ( 3, 3, 2 ) 

C20A0 OTMpMSTDM T(it#4) 

02050 C TPANSFOPM EULER SYMMETRIC PARAMETERS TO DIRECTION CDS.INj;S__R ELATaVE 

02060 C TO E’CT axes 

02070 on 10 T = U3 

02080 T(I,I) = _ __ _ . ^ 

02090 10 CnNTINUF 

021C0 T(1#?)=X1{3) 

02110 T(1»3)--X1(2) 

C'2120 ta,A) = Xltl) 

02130 T(2#3)=Xin> 

j 02140 T(2»4)=X1 (2 J . . . , . 

I 02150 TC3»4)«X1(3) 

i 02160 T(2#l) = -T{ 1,2) 

02170 T(3,l) = -T(l,3) 

j 02180 T(3,7) = -T{2,3) 

’ 02190 Tt4,l) = T(l,4) 

i 02200 T(4,?) = T{?,4) 

02210 Tf4,31 = T(3,4) 

02220 T(4, 4) = -XI (4) 

02230 on 40 t=l,3 

02240 DH 40 J = 1 , 3 

02250 B{I»J,1)=0. 

02260 on 40 K=l,4 

02270 3(T,J,1)= 3(1, J,1 )+T ( I,K)*T(K, J ) 

02260 40 C'lMTTNjur 

02290 ppthpm 

02300 END 

- 02310 C 
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f 


02320 C 

C/3100 

03110 C 

03120 

03130 

0314C 

0315C 

03160 

03170 

03175 

03180 C 

03190 

03200 

03210 

03220 

0323G 

03Z4C 

03250 60 

0.3260 
03270 
03280 

03290 

03291 
03300 C 
03310 
03320 
03330 
03390 

03350 23 

03390 C 

03400 

03420 

03520 

03530 

03570 45 

03590 30 

03600 
03610 
03 62C 

03o3C 20 

03640 22 

03650 50 


SlPO''lJTT\’F Xii'KNl 

odtmts fSTTMftTtD iTAIE VECTuP AND S/C ATTITOOE f.ATRIX 

cnMf>nw/i/^r-. ndelp^nni 

rnviMnM/?/TTW£, TC^TF# DELT,KDELT,Xl(4)#XlLt4) 

CnMyiTN/B/PIl^uC x2 ),TAU( 3j6) ,WH{6)>DRFT(6)#GYC9^6) 
C^^^^‘nN/5/SSV(27^^)^PP (3),B(3, 3^2) 

DTMFMSTHN Ct3^3)>D(4) 
rA=?D6?A4, 81 
>^7 = 1 

Dt>TNT HFAOINt AND TIME 
WPTTF(?»30) TIME 
CALL LARATT. 

DC 60 T = 1 » 3 
'^0 6n Jr' 1,3 
C(T,J)=n. 

Dfi 60 K = lj3 

C(T> J)=C(T# J ) + B( )+8U#K^2) 

n(i)=CA*r c?> 3) 

0(2)=^ A’^-C ( i ) 

0t3)=CA=?^Cn » 2) 

D{4) = 50PT{P( 2)‘f‘=i=2'tD( 3.)*=S=2) 

DISPLAY TIMF,D(4):»0(i) 

PPTMT ESTIMATED tULER PARAMETERS ANO S/C AND LAB ATTITUDE MATRIX 
WPITF(2#20) a,Xl(I),B( I#l^l) jb(I,2#l)#BU#3,l)> 

1B(T>1»2)^ 8 f T>2»2),-3{ Ij 3»2),D( I)#l = l>3) 

WPTTE(2»22) XH4) .^0(4) 

WPITEC5j23) TlMEi D(4 tl)#N7 
FnPMAT(3t2X, tl3,6)^ 2X> 11) 

OPIMT HFADIMb 
WPITF(?#50) 

00 45 T = 1.NM 
PTMlJlAsrA + PTiviutl) 

WPTTF(2,?1) ijpIMClA 
CONTINUE 

FORMATC X///f>H TIME = E 16 . 9/ / 30X> 

150HFSTIMATFD SPACECRAFT ATTITUDE RELATIVE TO ECl AXES//X, 

23NNC. »X^ 1 1 UCuLLF F ARAKf I2X, 17HATTITUCE E S TI MATE , 27 
317HLAB ATTITUDE^ Ux,i<:HRjP^Yj»<5S EK//) 

FHPf^AT f y» n,2X,Fl2,9»X,3(X,F12.9Ji2X>3{X,H2.9)»2X^F9.2) 
FnpMAT(X#lMA,2X, F 12.9^5 3X/F9, 2) 

FPOVAT f X/14Xj Z6HESTIMATED &YFC DIAS VECTOR/) 
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i^aiiiri Msa rmm raari (^j 
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0366C 21 PnPMAT{15V,Ii,4X# E12.S) 

03670 PPT1JPV 

03660 FNH 

03690 C 
03700 C 

03710 SUBRDIJTTNF PRNT(Kl) 

03720 /MG#nD£LP,NM 

03730 CnM^'nKi/p/TIMt^ fO, Th , D t L KDE LT # X 1 ( 9 1 j. X IL ( 9) 

03740 CnMMqN/f /NTP#1CAT^ NO^ YL(2>2) 

03760 C'^Mw^M/7/Yf' ( 2>2 ) # Y U> 2.3 » U(16 ).aA%.JL2* 3#,2 US.TR L3^ 2.3 

03760 CPMMOM/P/P (7#7),R(2# 2)j AK(8j 2 )?HMAT{2 j»7) 

03770 DIMEMSTHN P T t 3 j 3 3 j F ( 3, 3 3 # TP £ 3, 3 3 

03775 N7=2 

03760 C PPIMT5 IN': ERROR tOVAklANCE MATRIXjUPPER LEFT 3 BY 3 IN 

03790 C Sf^ALL ANGLE FGP^l 

0380C C SAVE UPPER 3 BY 3 . _ _ 

03810 no 40 7 = 1,3 

03020 no 40 J=l#3 

03830 40 PTI t » J.) = P ( I » J 3 

03840 C CONVEpf UPPER 3 BY 3 OF P MATRIX TO SMALL ANGLE FCRM 

03850 F(lf 1 3*?.*fXl£4) +X1 ( 1 3 *=«'2/Xl (4 ) ) 

03860 F(l»7j=2,«(xi£3)+Xl£13>*=Xi(2)/XlL4)) . 

03870 FU#3)«-2.’!'( Xi{2 3-Xi £13*xi (3)/Xl£43 } 

03880 F(2>1)--2.«{X1(3)-X1(2)«X1{1) /Xii4) 3 

03890 F(2»?)=2,*(X1(4) +X1 ( 2 3 4>S'2 /XU 4 3 3_ . 

03900 F(2,3)=2.«(XiU)+Xl(2}*xi£3)/Xl(433 

03910 F(3fl )=?.*(X1(2)+X1(1) “i'Xin) / Xl(4) 3 

03920 Ff3»?)=-2.*{Xl(13-XU2)«Xl(3)/Xl(^)} 

03930 F(3»33=2.*(X1 ( 43 +X1 ( 3 3 **2/x’l £4’3 ) 

03940 no 70 T=l#3 

03950 no 70 J=l>3 

03960 TP(T,J)=n. 

03970 on 70 K=l»3 

03980 70 TP(T> J)=TP( T, j 3+F(UK)*F{ JjK) 

03990 DO 75 1=1,3 

04000 75 J = l»3 

04010 P(T,J)=C. 

04020 OP 75 K=l»3 

04030 P(T,J) = P(I»J)+F(i,K)'!<TF(K, J) 

04070 NA = NN’1+3 

0410C C PRTNT UFADTNG 

04110 1C WPTTF(?,1) 
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^ 0^120 1 F'^PMAK lHl#50X»dHF flATPIXJ 

0A130 >^r> ?o t = i,k‘i 

041A0 W'?ITF^?^?) T 

04150 3 F'^PMAT(/PX,An(vOU >12/» 

04160 C PPTMT P MATPIX 

04X70 20 WPTTE(?>3'^) { P { 1^ J ) > J = 1 >NA ) 

i 041b0 30 FnPMAT(3X»6P17.6) 

I 04190 TF(K1.'=0,0) GO TO 44 

04200 C PPIMT STAO NUMBER 

04210 50 WPTTF(2,45) ICAT 

04220 45 FDPMATC / 7a,14HSTAR NUMBER = >13) 

“ 04230 TSTl=Ynt2,?) 

! 04240 TST2 = YD(l,2y , . 

; 04250 0FL1=(TST1*-YU{2>1) )’^206264,61 

04260 nEL2=(TST?~YD (1,1)) =('206264.61 

i. 04280 WPTTF{2,60) TS T1 , DE L_1 , T ST2, DE L2 _ . 

^ 04290 60 FnpMAT(3X,37HTRACKER OUTPUT ANGLES ANQ MEAS. ERROR/ 

04300 l5X,7HAZIMUTH,2X,Eli.4,5H R AD . , 3X, FlC . 3, 

04310 27H APCSFC/6X,5HUhV ,3X>E11.4,5H RAD.>3X,F10.3, 

j 04320 37H APCSFC) 

04330 44 CPNTTNUP 

; 04340 AT=SCPT(P(2f 2) +P ( 3, 3 ) >*206264 , dl 

' 04350 WRITE (?, 39) AT 

04360 39 F9RMAT(26H SORT OF POINTING TRACE » ,F10.3*9H ARC SEC.) 

04361 ATl=SQPT(Ptl,l) )*206264.81 . . 

04362 WPITF( 2,391) ATI 

04363 391 FHRMAT (X»I7W60K£SIGHT ERROR = ,F10.3,^h ARC SEC.) 

; 04365 WRITP(5,R) T IME, AT, A U; N7 

I 04366 e FnRMAT(3(?X, bl3.6),2X, ID 

! 04370 DTSOlaY AT, ATI 

I 04380 C R'^STCPF p MATRIX 

■ 04390 on 4^ T=l,3 

i 04400 nn 43 J=l,3 

! 04410 43 P(T» J)=PTCT» J) 

i 04420 PETUPN 

; 04430 END 

f 04440 C 

^ 04450 C 

04930 SUBR^UTTMC tnPUT 

04940 C PFAn$ tN ANP PRiMS INITIAL VALUES, SYSTtf'i PARAMETERS, RUN COFTRUL 

04950 C Cf'N'JTAMTS, AND CUNVERTS SPECIFIED ANGLES Tu RADIANS 

04960 CnMMPN/T /Nr.,sDELP,NNl 
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( G^El (.?f^?J (r***»:i [‘^***’•1 


0497C Cr*«MnM/?/TT^^t» I0 >TF>iJELT^KDELTjX1(^)jX1L{4)jKSKP 

0^9bU rnMMnv,/T/pxs‘u(l2),TAU(3,6)>wH(6)#DRFT{£))j»GY{9,6) 

04990 r^‘‘1vnM/i,/PMTx (4,4)j PHia{'i>3)#Q(7j7)iC0{<^^ 6>,WR( 3>2)>RP(4>9) 

05000 CGf^N"^W/';/«^5rv(27#2),pp(3),B(3#3#2) 

05C10 C^^’^^^S/6/NTP# ICATjN0#YL(2»2) 

05020 CnMMnN/7/Yn(2,2)*Y{2#2)jU(lg)f AST(3 j3j2),STR(3>2) 

05030 C?MRnM/P/p(7,7)>R(2>2}^ AK(6,2)^HHAT(2#7) 

0504G nT'iP’'JSinN w«:v(4,32)>C (3*3) »T(3) 

05050 N^=:WMl+7 

050t>(j Pn 112 T = 1»'-!N 

05070 DO 112 J = 

05080 112 P(I* J )=0( r* J )=0. 

05090 C RFA'^ INPUT FLAGS DEFIMN6 TYPE OF RUN. AND PR INT OPTIONS .. 

05100 RFAPn,?) MTK*NG 

05110 2 FOrhaKID 

05120 PF4P{1*3) Nn£LP*KSKP . . 

05130 3 PHRMATUB) 

05150 C READ NCPIMAL STAR TRACKER TRANSFURMAT ION MATRIX 

05160 , DO 20 K = 1*NTR . 

05170 20 PFAPn.4) ((AST(l*J>K),J = l»3)*I = i*3) 

05180 4 FnRMAT(F9,6) 

05200 C REAP <vTAP SFnSOK PARAMETERS ... 

05210 on ?A J=1,NTR 

05230 24 PFA0fl»5) ( SS V ( I* J )* 1=1* 9) 

05240 5 F0RMAT(F9.3) 

05250 C REAP GYPD PARAMETERS 

05260 DP 25 J=1>MG 

05270 25 READ(1»6) ( G Y ( 1* j ) * 1 = 1* 9) 

05280 C RF4D FSTTMATEO INITIAL RATES 

05300 on 27 1=1.3 

05310 27 PEAn(l,6) P® ( I) 

06330 6 FnpMAT(Fl.?,6 J 

05340 C RFAD INITIAL 4 PARAMETER ATTITUDE 

05350 RFAD(l.A) { X I ( I ) , I = 1* 4 1 

053t»0 22 CONTTML"^ 

05370 C PEAP TNTTTAL AnD FINAL TIMES AND INTLGkATION STEP SIZE 

05380 PFAr«fl,6) TO*TF#DELT 

05390 C RFAP EPOpP r<JVARIANC(. 1M11AL DIAGONAL LLLMENTS 

05400 C UNITS APp pAu,*SFC 

05410 P'^ ?F 

05420 28 PEAn(i,6) P(1*I) 

05470 C 




i 


05490 

C 


TE'IPOPAPY IWPUT print ROUTINE 

05500 



WOTTP(P,17) 

05510 


12 

p^pM^iTUHl ) 

05 52C 



WPITF(’,7) MTt?»NG^NOEL,P 

05540 


7 

FOPYAT( 3(X»I3)/) 

05 560 



nn 33 J=i*Nr; 

05570 


31 

WPTTPfP.P) CGY(I> 

05580 


8 

pnR«AT(atX» FIO.3) ) 

05590 




05600 


10 

FnRVftT(/) 

05610 



DO 32 K=1,MTR 

05620 


32 

WFITFt?,0 ) { (asT( 1> J*K)»J=li3)>I=l,3) 

05630 


9 

pnPMATf ofX>F.9,6) ) 

i 05640 



WFITE 

i 05650 



nn 34 J=1,NTK 

i 05670 


34 

WOTTEtP/ll) (SSVtl>J)^ 1=1^9) 

05680 


11 

F0PMAT(9f X, F10.3) ) 

05690 



W»ITF(2#10) 

05700 



nn 35 J=l »3 . . 

i 05720 


35 

W'’TTF12,F) pp{j) 

05730 


41 

CnNTTNUF 

05740 



WPTTF(2,10> 

i 05760 



WPITE<?j 8) ( xi{Il^I=lj4) 

05770 



WRTTF(2^10) 

! 05780 



DO 37 K=1»NN 

05790 


37 

WRTTE(2,e> PIK^K) 

05800 



WRTTF {PjlO) 

L 05810 



WPTTF{9,P) to>te#delt 

05820 



WPTTH(2»10) 

05080 

C 



05890 

c 


IMITIALIZF PkOBLEM time 

05900 



TTMF = TO 

05910 


15 

FOPMATHHI ) 

05920 



WPITF(?,15) 

0 5930 

c 


CONVERT ANGf-ES TO RADIANS 

05940 



CF = 4 «B4P13o8E-06 

05950 



C'^''0 = CF^CR 

05970 



nn jo j=i»^'TR 

05980 



nn 131 1=1,7 

i 05990 


131 

SSV(T» J) = CF=(=SSV(ijJ) 

06000 


13C 

CONTI NIJR 

0602:0 



nn 1 35 J = l ^ ^'6 




wiBBsi riaBin (.’iwi {’«^l i'^fej tjiaw.’i 


i'-'gsml 


06030 
0604C 
060&C 
06060 
0607C 
06080 C 
0609C 
0610C C 
06110 
06130 
06160 
06190 
Q6200 C 
06210 C 
06220 
06230 C 
06240 C 
06250 
06260 . 
06270 
062B0 C 
06290 C 
06300 
06310 
06320 C 
06330 
06340 
06350 
06360 C 
06370 
06380 
06390 
06400 C 
06410 
06420 
06430 C 
06440 
06450 C 
06460 
06470 
06460 
06490 


GVn, J)=Gy(l#J)«CF 
on T=7»9 

'^Ydt J)=GY(Ij. JJ*CF 
135 O^iNTIMIF 

CALL TNTTTAL 

PPTNT FPPPP CUVAklANCE MATRIX 
CALL PPNT(O) 

PPrVT Tk^'.TTAL STATE VECTuk 

CAM TPMS 

CALL XIPPNT 

RFTUP^5 

FNO 


SUnRC'JTTM.F 7tK0 

IMTTTALTZFS STATE TRAr^SIT JUN. MAlTR.IC.LS Phil jNp .Phi2 „A.fTi:R £AC.Ij.. 

ftltfr update 
C0MHnN/l/M6*NDELPj NNi 

CnMMnN/?/TIMEj,Tp#TFj»,P_ELT»KDJ.LXj.X_lt4l^XlL( 4) , 

COMMUM /4 / P HT 1 { 4j 4 J > HH 12 ( 4, 3 ) » Q 1 7^ 7 J , 00 ( 4, 6 ) > Wft ( 3 j 2 ) ^ R P ( 4, 4 ) 
RFTAJM FILTER UPDATED VALUES OF EULER PARAMETERS FDR NEXT FILTER 
nPERATTUN ^ . . 

on ?i 1=1,4 

xiL(n=xi(T> 

SFT PHT1 ELFhENTS EQUAL TO ZERO 

on 22 J=Ti4 

PWI1(T,J)=0. 

22 rnNTINUF V . . 

SFT PHT2 FLfKenTS E^’uAL TO ZERO 

DO ?3 J=1>NN1 
PHI?{ I, J>=0. 

23 rCMTINUF 

SPT pHTi diagonal elements ecual to one 

P4T1(T,I)=1, 

21 ccntinuf 

SFT 0 matrix CuhPLTATinN INTERVAL COUNTER TC ZERO 
KnPLT=0 

SPT 0 «ATRTX ELEMENTS To ZEFC 
m lo T=l,7 
Pn IP J=1»7 
10 CLT»J)=0, 

pcjup^- 
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06500 
06510 C 
0652C C 
06530 
065*»0 
06550 
06560 
06570 
06580 
06590 
066CO 
066X0 
066.20 C 
06630 
06690 
06650 
06660 
06670 
06680 
06690 
06700 
06710 
06720 
06730 
06790 
06750 
067e0 
06770 
06760 
06790 
06800 
06810 
06820 
06830 
06890 
06850 
06660 
06870 
06660 
06890 
06900 
06910 r 


EKJD 


5U8PnUTTM? INITIAL 
CCIMWOM/i/Mf;, N0ELi^#NM 

r-iMMni.j/?/TTMt,TOj lF^0ELT^K0Eir>Xl{9)»XlL(9) 

CnM«nM/3/PT^lU( 12)#TAJt3>6)jWMl6)j»0RFT<6)^GY (9>6) 
C'1MvnN)^4/PMT i (9,9),PHI2(9»3)»Q(75 7}>C0(9,b),wkt3#2)»RP(9,9> 
C^'1W^(^'/5/!^SV(27#2 )>PP (3 )#B{3,3>2) 

ICAT; NO#_YL (2i.2.) 

CnMMnN/8/P{7#7)»k(2^ 2)i AK(8 j 2) #HMAT(2»7) 
niME^J^THN TPi (3#3 ),TP2( 3 j3)>TP(3» 12)#TP9{6>3) 

compute RYPn WEIGHTING HATRl.X^, T_AU . 

no T2 T = 1.jNG 
on 1? j=i>3 

12 TP9(I. J)=(1. + GY( 2^ I ) )*GYJ3+J>.IJ. .. 

OD 10 I=1j3 
DO in J=l,3 
TP1(T»J)=0. 
nn 10 K=lfMf' 

TP1 fit J) = TP1 (I#^1) + TP9(K>T)*TP9(K,J) 

10 cgnttnup . . 

P'^L=TPl n,l)«TPll2,2)=!'TPlt3#3)+TPl{li 2)*TPit2^3)«TPl<3>l) 
1+TP1{1..3)=«^TP1( 2> 1)*TP1(3>2)-TP1I1>3)*TH112^ 2)*TPl(3>i) 

2-T P 1 n > 1 ) *T P 1 ( 2 , 3 ) # T P 1 1 3 # 2 } ~T ? 1 ( 1 j 2 » * T P 1 ( 2 >1 ) *T PI (.3, 3 ) 

01=1. /OFL 

TP’(m) = (TPx( 2j2)^TPl{ 3,3>-TPlt3,2)>i'TPil2^ 3) )*DL 
TP? (Ir 2) = {TPU3,2)={=TP1(1,3>-TP1(1».2)*TP1( 3>3) )>i‘DL 
T0?(1>3} = (TP1 Uj 2)=i‘TPl(2>3)-TPi(2^2)«TPiU#3> >*DL 
TP2{?^1) = (TP1(3,1)*TP1{ 2 j 3 )“TP1(2>1)*TPH3, 3) )*DL 
TP?(2»?) = (T?l(i,l)<‘TPl(3#3)-TPlll,3)*TPl(3, 1))«DL 
TP2(?#?) = ITPi l2>l)*TPl(i,3)-TPl(l^l)*TPi(2, 3) )=«‘DL 
T®? f 3»1 ) = (TPit2> l)=flPl {3,2}-TPl(3>l) + TPU2#2) )«i)L 
T P ? ( 3 ♦ ? ) = C T P 1 { 3 # 1 ) ’i' 1 P 1 ( 1 # 2 ) “ T PJ, ( l».i ) * T P 1 ( 3 > 2 ) ) * C L 
TP2(3,“)=(TPi(l# l)*TPlt2#2)-tPl{2#l)*fpl(l>2) )*DL 
on 15 I=l»3 
on 15 J=1»NG 
TAU(T» J)=0, 

15 K = 1 , 

TAU(T*J)=TAUlI»J) + TP2aiK)=i=TP9{J,K) 

15 C^NTTN’UF 

TMITIALTZF PA3f DATA 


am 

tel 


© 


^ cl 

Sp 


r\. 
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06930 



'’O T = 1^^'G 

06960 


20 

0PPT{T)=^^y{1 , 1 ) 

06960 



nn 30 T=l , 3 

069fC 


30 

W'>(T*l)=WP(Ii2)=PftIJ 

06990 

C 


CnMDuTF THTTIAL oYRDPACK PARAMETERS^ PlhU 

07010 



on AC 

07020 



PIMU(I)=0. 

07030 



00 90 

070<»0 



PT'1U(T) = Pir*U(I)+TAU{ I, 0 )>!'a, + 6Y(2,J})^‘GY{1> J) 

07050 


90 

CONTT^fUG 

07070 



L = 3 

07060 



no 50 1=1,3 

07090 



on 60 J = li>3 

07100 



L = L+1 

07110 



PTMUn. ! 

07120 



on 60 K1=1,NG 

07130 



PIMU(L )=PIMU IL )+TAU( I,K1)*(1.+GY{2,K1) )*GY(3+J,K1) 

07190 


60 

CnNTTNUF 

07150 



PTMU(9*T)«PIMU.{9=(«I )~1, 

07160 


50 

CPNTIMUF 

07170 

C 


COMPUTE TAU«TAU-T’^SIG-SO FGR USE IN 0 

07180 



on 65 J = 1,^*G 

07190 



TP3 = S0RT(GY( 7, J )'^=f'2=^100 . 00*6 e’lT + GY( 9, J ) «+2") /iOG./DELT 

07^100 



DO 65 T=l,3 

07210 



TP(T, J + 6)=TAu{ I, Jl’i'CYCb, J) *SQRT ( 100. «D£LT ) 

07220 


65 

TP{I,J)=TAU(I,J)=i'TP3 

07230 



on 70 T=1.3 

07290 



on 70 J=l,3 

07250 



OOt I, J)=0, 

07260 



00(T, J+3)=0. 

07270 



on 70 K= 1 ,M 0 

07280 



OOf T» J + 3)=00 (I, J + 3 )+TH ( X, K + 6 ) * F P ( J, K+6 ) 

07290 


70 

00(T, J)=QO(T, J) + TP( I,K)*TP( J,K)*2500.*OELT=i'DELT 

07370 

C 


CnMVpPT U»Pi^K LEPl 3 bV 3 GP P MATRIX TU EULEk SYPMETkIC 

07360 

C 


PARAMFTFP FORM. URIGINAL P ASSUMED DIAGONAL. 

C7390 



ZI = P{1»1 ) 

07900 



Z?=P(^,?) 

07910 



Z?=P(^,^) 

07920 



PC .1) = .^5=!^( Zl=!'XI(9)¥>?2 + Z2’i‘Al (3J>f'=;=2 + Z3>s'Xl (2 )**2) 

07930 



P(l»'’) = '’f2,l) = .25+((4l-Z2)<'Xl(9)'«'Xll3)-£3’l>AUi)*U(2)) 

07990 



Pfl,3 )=PC3,1 J = ,25’i‘( {/3-213 ’i‘Xl (9)=4‘X1( 2)-a2*X1(1)*X1 (3) ) 

07950 



P ( 2 , ? ) = . ( Zi-^X 3 ) *':‘Z+Z2 + X1 ( 9 ) »!'«2 + Z3 + x i ( 1 ) ) 


07^60 P(?,3)=P(3).? J = (Z2-Z3)#Xltl)*Xl{'i}“2;i*Xl(2)«Xl(3n 

0 7470 Pf3»’) = .?5*(Zi«XI(2)^‘<‘2 + Z2^Xl(l)>f'«2 + Z3>i‘Xi(4)+»!‘2J 

076C0 RETI'PM 

07610 FNO 

C7620 C 

07630 C 

07640 SURRHUTT'^'^ STRCHKCYG) 

07650 f'nMt'PN/l » mDELP>NM 

07660 CO*<MnM/?/TlMt # TUi TF> DELTi KDELT#X1 (4 ) flXlL (4) 

0767C C^M‘^^^J/5/^c:V(27,2)^RPl3)^B(3^3^2) 

07680 Cf^l1^"nN/6/MTR,ICAT^N0>YL(2>2) 

07690 COMMON /7/Yn{ Z>2)^Y(^J2)JU(15)^AST(3>3^2)#STR{3>2) 

07700 TCAT»2 ' . 

07710 TF(yG.GT..1} 1CAT*1 

0772C TF f YO.LT.-.I ) ICAT=3 

07680 100 Cr>MTTMUF _ 

07890 YL(1»1)=YL (1> 2)=Y(1^ 1)=YD(1^ 1) »YD( lj2)=Y(l>2) 

079CO YL(2»1)=YL(2j2)=Y(2j1 J=YD(2>1)=YD(2#2)=Y{2>2) 

07910 RFTUON 

07920 FWn 

07930 C 

07940 C „ - 

07950 SURROUTTNE STARDC ( C > I S TRj T0 L) 

07960 COHMnN/2/TIMc^ TCj TF#DELT>KOELT>Xl (4) # X1L(4) 

07970 CnMMDM/5/SSVt277.2)jFP{3) jBJ3»3^2) _ 

07980 nTMPMSTPM Cf3)#TP(3,3),RNl3)jD(3) 

07990 C nFFIM^ STAR DIP. COS, IN LAB AXES 

060GC TP(1»1 )=-.6Po6902 

08010 TP(1»2)= 4.7424E-5 

08020 TP(?^1 )=-. 3544475 

08030 TP{?»21=2.153E-5 

06050 TP(?.l >=-1.020237 

08060 TP(3»?)= 4.512E-5 

OeOBC CALL TRNS 

08082 TT=?.*TP (ISTR,1) 

06064 TW=TP ( TSTRj 2 ) +TBL 

08086 DM )=-STN(TT J^^'CQSCTW) 

06086 D( ?l = STMtTT) 

08090 D{3)=Cr'S(TT> 

08180 C F'^R" LAP TVFRTIAL ATTllUDE 

06190 CALL LARATT 

08200 C C^HVFPT TD TNErTIAL CDDRD. ^ 
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i 


0b2IG nn 20 I = T.j3 

j 08220 C(I)*0. 

06230 on ?0 J=l»3 

062<f0 20 C<T)=r m+” ( 

0625C RPTUPM 

06260 FMO 

08270 C 
06280 C 

08290 SUARnijTTWg LABATT 

.08300 CPMrnM/?/TIHtATO, JF,DtLTjKDFLT,Xl(9),XiL(^) 

i 08310 CnMMnN/5/SSV{27,2)j PP (3),B(3»3>2) 

08320 RTA«1.-C0S(7.2722C522E-5>^TIME) 

j 08330 '=’.1-0* .. . . - . 

■ 083^0 P? = n, apa'Qfir'C(i,i 

i 08350 P3=0 . 557701099 

08360 AI=SIH{7.27220522E“5>^T1HE1 

08370 B{l»l»21=i.-BTA*(ft2*+2+R3«42l 

08380 B(1»?»?)=AL*R3+BTA«R1*R2 

.06390. 2)=^-Al*R2 + BlA=<'il*R3 

08900 8(2*1*?)=-AL'5‘R3 + B1A’^R1*R2 

08910 Bf ?r2f ?)=1 .-BTA»(F1**2+R3*«2) 

08920 P.(?»3.?) = AL*K.i+BTA + R2*R.3 , . . _ 

{ 68930 3r3,l/2} = AL*K2+BTA*Rl=4'R3 

i 08990 8(3»2>2)=-AL>4‘Rl + 61 A*R2»R3 

I 06950 R(3»3,2)=l .-BTA*(Ri^=?2 + R2’fr*2) 

! 08960 RETUt>M 

I 08970 FMO 

I 08980 C . 

i 08990 C 

I 06650 SURPnUTTME PYPCK 

i 08660 C^MMniv/l/NG.N06LP>NNi 

j 06670 /?/pT*^1jC 12 ), TAU(3* b) ,!««( 6)#DRFT(6)» GY (9»6) 

0 6680 CnMMP!vi/9/PHTU9j9),PriI2 l9,3)>0(7^7)»C0(9,b)j«k{3,2)jRP {9i 9J 

08690 OTMFW'^TnM Tr>i3) 

08700 C pPnVIPFS ESTIMATED S/C RAIFS BASED UPOlv CCMPENSATED GYROS. 

06710 pn in T=1,3 

I 06720 C ‘^'^TFT PREV/J'^US FATE DATA eACK CNE STEP 

; 08730 ls(0( I,9)=wo( T>i) 

! 08790 C rnMotjJP View oYRL PACKAGE RAU tSTlMAfE 

'I 06750 TO(T)=-PTKUf i) 

! 087bC m 10 J = 

0677C T®{T)=TP(T)+ |AU(i> J) 
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\;i 0b780 ,10 CONTTNUF 

08790 

08800 *^0 ?0 T = l#3 

06810 U"? ( 1,1 )=TP( TJ 

08820 on 20 J=l,3 

08830 L=L+1 

oea'^o w’d,! )=w!?(i j?x)-PiNu<L)*Tp(j ). . 

0e&i»0 20 rONTTNl'F 

08860 PCTUPV 

08870 FNn , ... , . - 

08880 C 
08890 C 

09220 SUPPHUTTNE ATT — - - - 

0923C C DFRFPP^S MU^tKlCAL Ii';TEGRAT10lM TO DETERMINE SPACECRAFT ATTITUDE 

092A0 C AS PEPPFSENTtD uY EULtR SYMMETRIC PARAMETERS 

i 09250 rnMMnM/?/TT^’E,rG,TF,DELr,KDELI,Xl(4),.XlL.tAi 

09260 CnMMnK/A/PWri(4,A),PriI2(9,3),b(7,7),Q0(9,6),WR(3,2>,RP(9,4> 

I 09270 DIMFNSTPN T{5),TP13) 

09280 on ?0 1=1,3 . . 

! 09290 20 TP(T) = .5=i'{WP(I,l)4WR(I,2) ) 

09300 C pnMPUTE S(0) FOR USE IN PP MATRIX 

09310 T(?) = lTPn )**_2 + TP(2)**2+TP(3)'«‘*!‘2)^i)_ELJ.=*‘*2/A., 

”09320 Tfl) = SQPT(T(2)) 

09330 T(2) = CnS(TU) ) 

09390 T(3} = ,5 _ .. - . . 

09350 TF(AP$ (T(l ) ) .LE.l.E-20) GD TO 6 

09360 T(3) = •^TN(Td)) 

09370 T(31=T(3) /(^».«T(in 

09380 6 CONTTNUF 

09390 C form rp .matrix FOR PROPAGATING EULER PARAMETERS 

099C0 PP(l,2}=T(3)wTP(3)=«‘0ELT _ . . . 

09910 PP(1,3)=-T(3)*TP(2)+DELT 

09920 PO(i .9)=T(3) *TP(1)*D£L1 

09930 PP(?,^)=PP{1,9) . . 

i 09990 RP(2,9)=-PP(i,3) 

09950 PP(3,9)=PP(1,2) 

09960 on 10 1=1 ,9 

0997C PPtT*TW-T{3J 

09980 1C J = 1 f T 

09990 PP( y» J )=-PP ( J, I) 

09500 10 CONTTMUF 

09530 CALL PHT 
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09bi*0 C 

09560 

09570 

09560 

09590 

09600 

09610 C 

09620 

09630 

C9690 

09650 

09660 

09670 

09660 C 

0969C C 

09700 

09710 C 

09720 

09730 

09790 

09750 

0976C 

09770 C 

09780 

09790 

098C0 

09610 

09620 

09830 

09890 

09850 

09660 

09680 C 

09690 

09900 

09910 

09920 

09930 

0999C 

09950 

09960 

C997C 


PDnnAr.ATF EULtR PARAi 1ETE)^S 
rn 1? T=i,9 
T ( T ) = n . 

1 ? J = ] » 9 

T(n=T{n+pp(iij)*xi(j) 

12 chntinue 

NnpMALT7F FlJLEk PARAMETERS 

T(5) = ’^0PT{Ttl)>^=(‘2 + Tl2)=i=>i‘2 + T(3)*«2 + T(9)=!‘*2) 
OP 19 T=l»9 

yi(T) = TfI)/T(5) 

19 CnNTINtJF 
OPTURN 

_ FNO , . _ _ 


SUBRniJTTNF Phi 

COMPUTFS THF STATE TRANsiflDN HATRICES PHIl AND PHI2 
COMMCN/i /MG, nOELP^NM 

CnMMriN/?/TTME« T0 jTF>DELT?KDE LT.> X 1(9) jXlL(9) 

nMMpM/6/PHIU9,9)i PHI2 (9, 3),Q(7#7)#cd(9,6)^KR(3,2),RP t9,9) 
DTmfnsTON W(9)jTi(3>i2)>PK(9j3),PHI2T(9>12),TPl(7,7)#TP2(7,7) 
OTME^SinN P0t7j7) 

COMPUTE' PMTl 

m 10 J=l»9 
on 11 1=1,9 
wf n = 0 . 
no 11 K=l,9 

W(T )=W(T ) + PP (1,K )>»HhIl(K, J) 

11 CPNTINIJF 

nn 10 T=ii9 

PMIKT, J)=W{ 1) 

10 Fn\|TT''*UF 

poMPUTF PMTP 
nn A? T = i, 
nn A? J = l,N\'l 
puT2T(T,J)=0. 
rn a 2 x = i , A 

A? =HTrTfT,j)=onj[^7(i,jj+RP{I,K)<fpHI2(K,J) 
fl'^ ]A T = l,3 
PK ( I . T ) = V1 { /,) 

19 GONTTMLIP 

'Ji< VI 13) 
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099b0 PK(1,3)=X1 (2 J 

09990 0*^(7j.3 J=-Xl(x) 

10000 PK(?,1 ) = X1(’ > 

10010 PK{3,1 1=-V1 f 2) 

10020 ) 

10030 PK f 4,1 )=-Xl ( 1 ) 

10040 PK{4,2) = -XK2) 

10050 P!^( A, 3)=-X1 ( 3) 

10060 on ?o 1=1,3 

10070 on 31 Jsl,3 

lobeo . 31 T1CT,J)=0. 

10090 30 T1(T,I)=-1. 

10210 Jl=l 

10220 pn 10 j = 1,3 

10250 on 32 1=1,4 

10260 TZ = 0. 

10270 DO 23 k: = 1,3 

10280 TZ = TZ+PK(T,K)«T1(K, J) 

10290 23 CONTINUE 

10300 PHT2(T,J1) = PHlZTd, JD + TZ 

10310 22 CONTINUE 

.10320 .. . J1 = J1 + 1_ _ 

10330 19 CONTINUE 

10350 C UPDATE 0 IF TIME IS APPROPRIATE 

10360 i^PELTsKnELT+l 

10370 IF{knFLT,LT. 100) GO TO 50 

10380 KPEIT=0 

10390 DO 55 T=l,4 

10400 DO 55 J=l,3 

10410 TP2(T,J)=0, 

10420 DO 55 K=l,3 

10430 55 TP2(I, J)=TP2(I,J)+PK( 1,K)»!'Q0(K,J) 

10440 DP 60 1=1,4 

10450 nn on J=l,4 

10460 Tol(I,J)=0. 

10470 DO 60 K=l,3 

10480 60 TPl (T, J)=TP1 (I,J)+TP2(1,K)*PK(J,K) 

1049C on 61 T = ‘^,7 

10500 nn 6i J=l,4 

10510 61 T01(I,J)=TP1 

10520 m 43 T=5.7 

1C53G on (S’ J = 5,7 


“.i . 



Latisd Gmn {M raiS£;i i:,^j 




101)^0 62 TPK I, J )=Q 0 ( I-HJ J- 1 ) 

106b0 TO = PD ( ? , 1 ) «*2 + RM 1 ) ««2 + Rp ( i ) .}:«2 

10560 T<J = ^0PTfJ ,-7C0u0.*T-:() 

1057C O'" T = lft* 

10560 nn 64 J=l#4 

10590 POn. J)=PP(I, JUICO. 

106C0 64 PO{T+3,J)=0. 

10610 nr* J = l ,3 

10620 P 0 ( T» J + 6 )=- 0 ELT*K'h(I^ J)* 50 . 

10630 65 P0( T+3» J+4)=U. 

10640 R 0 {T+ 3 ,I+ 3 >-i. 

10650 P0(T#I)=T9 

10660 63 CONTINUP . 

10670 nn 66 1=1,7 

10680 nn ^5 J=l,7 

10690 , TP2(T,J)=0, 

10700 nn 66 K=l ,7 

10710 66 TP?{ I, J)=TP? 1 I, J)+Q{I,K)’S‘PO(J,K) 

10720 nq 67 1 = 1.7 

10730 n? 67 J=l ,7 

10740 0 (T, J)=TP 1 ( I, J) 

10750 m 67 K=l ,7 

10760 67 0 (T,J)= 0 (r» J)+RC{I,KJ*TP 2 (k,J) 

10770 50 CnNTTNUF 

10780 C PHT 2 MUPT STILL BE MULTIPLIED BY DELT /2 IN PRFIL 

10790 RFTIJON 

10800 F^O 

10810 C 

10820 C 

10030 SURRDUTTMB OMAT 

10840 C FHRW TMP STATE NDISE CuvARIANCE MATRIX 

10 850 COMMC*«'/l/NG»J(DfcLP,Ni\l 

10060 C 3 MMnN/ 4 /OHTl ( 4 , 4 ),PHI 2 { 4 , 3 ),w( 7 , 7 ),Q 0 { 4 , 6 ) ,WR( 3 , 2 ),RP( 4 , 4 ) 

10870 PTMPMSirM T 01 ( 7 , 7 ) 

10880 C PonpFRLY PACk 0 MATRIX 

10890 no 10 T=l ,7 

10900 on 10 J= 1,7 

10910 10 TPUT».n = 0 (T,o) 

10920 J 3 = ‘> 

10930 nn 15 T = i 

10940 Jl=^ 

10950 nn 17 ,|si ,3 
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1C970 J1=J1+1 

1G9C0 0CT,Jl)='2(.n,I)=THl(I#J+‘^) 

1099C i? r^NTTMtlP 

11010 J?=J^+1 

11020 J?a? 

11030 nn 16 j=i,3 

11050 J?=J?+1 

1106C 0( J3, J2) = TP1 a + 6> J + 4) 

11070 16 C^MTTNUE 

11080 15 C^^'^ITTNUF , . 

11160 PFTUt>N 

11170 END 

11180 C 

11190 C 

11200 ?impni.'TTMF TRAC(YG) 

1121C C rOMPUTPS Ti’ACKER GUTPL'T ANGLES FROM ATTITUDE AND 

11220 C TPACKFP TnFNTIFICATlDN NUMBER 

11230 CnMMnNl/2/TTMhj TO»TFi D£LT#K0ELT>X1(A) »X1L<A) 

112A0 CHMMON/B/SSV (27^ 2 J#PP (3)#B13# 3>2) 

11250 CnMwnw/f,/^TPj ICATjNO^ YL (2,2) 

11260 rnMMQN/7/YD (2,2)^ Y(2^ 2}j»U(15}# AST(3,3>2 )jSTR( 3>2) 

11270 OIMPmSTHN T(o},C(3,3)>TT(3) 

11280 YLn»l)=Yn»l> 

11290 YL(2*1)=Y{2>1) 

11300 CALL TPNS 

llAOO C CHMPUTF TPAC^ER Tk ANS F ORM A T ION RELATIVE TO INERTIAL COORD 

IIAIO DO T=l#3 

11A2C DC pO J=l,3 

il430 C(I»J)=0. 

IIAAO DO RO K»l»3 

11A50 C(I»J) =C( I# J )+AST{ NO)=i'B{K> J,l) 

11A60 80 CnNTTNUP 

11A70 C COMPUTF STA5 DIKECTIJh COSINES IN TRACKER AXES 

11A80 T = 1j3 

11490 U(I) = C(t»l)+STRllil) + C(Ij2)*STR(2*l)+C(I^3)’S‘STR(3,i) 

11500 90 CnMTTNUF 

11630 LI(5) = S0PT{1.-U(l)*>i'2) 

11820 C cr”^’PUTc TPAPKER uUTHUT IF IT HAD INFlixiTE OANDwlDTH (INTERVAL AVBt) 

11830 Yd, l)=~(Uni + SlN(YGn/U(5J~(SSV( 4, D + SSV {:>»!)» 

11840 Y(2,l)=n{3)-(SSV{3^1J+U(5)*SSV(l>l)~U(i)»S$V{2^1)) 


11890 100 RFTUP^’ 
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119G0 
il9iO C 
11920 C 
11930 
11990 
11950 
11960 
1197C 
11960 
11990 C 
120C0 
12010 
.12020. 
12030 
12090 
12050 
12060 
12070 
12080 
12090 
12100 C 
12110 C 
12120 
1213C C 
12190 C 
12150 
12160 
12170 
12180 
1Z190 
12200 
12210 
12220 
12230 
12290 
12250 
12260 
12270 
12260 
1229C 
1230C 
12310 


FMD 


'?Li'?PPUTTNF TkCFLT 

rnMwnw/?/TTMt> TO # TF # DE L T>KDEL T , XI (9 1 , XIL ( 9) 
rnviMriM/f /SSV(27 j2)5HP (3)>B(3#3,2) 

CnMI«nM/6/NTR, ICAT^NO^ YL (2#2) 

r^vlM^^•/7/Yn( 2,2)» Y(2>2) »U(15J>AST(3»3»2)* STF (3>2) 
C(2)>K(2) 

OPTVIPP': FTlTtPED TKACKtR uUTPOT 
C(1)=9SV( R,NO)/DELT 
C(2)=SSV( 9»N0)/0ELT 
Pn)=FXP(~T./C(i)) 

P(2)=ryp(~l ,/C(2) ) 
r'fi 10 K=i »? 
no 10 T=l,? 

10 Yn(I,K)=YO{I,K)’!‘R(I) + U.-C(I)*a.-R(i)>>«Y( 1#K) 

l+(r(T)*(l.-R (I) )-R(I) )>i<YL(I>K) 

RETURN 

ENO 


SUnRHUTTNE RRFIL 

CONVERTS 9-PARANhIEft ATTITUDE SYSTEM TQ 3 PARAMETERS AND MODIFIES 
STATE TRANSITION MATRIX 
CTMMnw/i/NGt NOELPjNNl 

CnMMOM/?/TTML»TO, TF pUEL T#KDELT^ Xi(4), XiL(9) 

CTMMp^/T/prf'uT 12 J,TA0(3f 6)> WM(6)^ DRFT (6 )» GY (9,6) 
C^M^10^J/9/PHTl(9,9)^ PHI2(9,3 ),j(7,7) ,00(9,6), WR( 3,2),RP(9^ 9) 
CnMMPM/'5/';sV(27,2),PP(3),B(3,3,2) 

C0NN0N/6/NTP, ICAT,N0,YL(2,2 ) 

rnMMnM/7/Y0(2,2), V (2,2),L( 15),AST(3,3,2),STR(3,2) 

COMHON/P/R ( 7, 7),P ( 2,2 ) , AK ( S, 2 ) , HMAT ( 2, 7 J 

^TWF^>5T^^^ ^.((3) 

W(1)=X1L(1 J />1L(9) 

W(2)=XU (2)/XlL(9) 

W(3)=Ylt.n)/XlL(9) 

in T = i , T 
n'’ TO J = 1 r 3 

RHTT ( T, .t)=RMii( l,o)-PhIl(I,9.i ^'w ( J ) 

10 C^NTTHIir 

nn 1 ? T = i , 3 
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12320 
1233C 
123^0 
12350 
1230C 
12370 C 
12380 C 
12390 
124G0 C 
12410 
12420 
12430 
12440 
1245C 
12460 
12470 
12780 
12790 
12800 
12810 
12820 
12830 
12840 
12850 
12860 
12870 
12880 
12890 
12900 
12910 
12920 
12930 
12940 
12950 
12960 
12970 
12980 
12990 
13000 
13010 
13020 
13030 


p':’ 1? 

j) = DMii;( I, J LT/2. 
f^MTT^MJF 

EVP 


5U8ROUTTMF HMRX 

COMoUTFS «FASUP£MENT matrix 

CnM^nM/l /WG»iN0£Lr> NM 

FnMMnM/2/TTMEj.T0>TF>UELT#KD£LT#Xl(4)>XlL (4) 
CnMMHH/A/MTPj ICAT#N0>YL(2,2) 

CnMMnw/7/Yn,(2,2),Y(2^ 2),U(15)#AST(3?3.2),STR(3>2) 
CnMMnM/P/p(7, 7),R (2#2),AK (8 j 2),HMAT(2W) 
nT«ENSIP"' T(33 ^ 1T(4>4)#T1(3#4) 
niMEWSinN TA(2,4) 

130 I = l»4 
TT(T>T)=0. 

130 CONTTMUE 

Tin . = -SrRt3#l) 

TTM,3) = STR(2#1) 

Tin, 4) = STR{1^1) 

TT<2,3> = -STR<i>l) 

TT(2#4) = STR(2,1) 

TT(3j4) = STR(3j1) 

TT(2,1 ) = -TT(1^2) 

TT(3,1) = -TT(1j3) 

TT(3>9) = -TT (2>3) 

TT{4j.l) * Tf(l>4) 

TT(4,2) = TT(2^41 
TT(4,3) * TT(3#4) 

T(1 ) = -XI (1 } /XI {4 ) 

T(2) = “X1(2)/X1{4J 
T(3) = -XI (3)/Xl{4) 
m 160 T=l>3 

no 160 J=l»3 

TT{T»J} = TT(I,J)+STR(I#11«T(J) 

160 rONTTVl'F 

nn 165 Tsl,? 

T1(T»1) = (-ASTtl,iit'iO)'!‘Xl(4)+AST(Ij2»<>iO>>!'Xl(3) 
l-ftSKTjSfVOl^i^XKa) 

TUT,?) - (-A3T(I>i/NC)=i=Xl(3)-AST{I,2*N0)^Xi(4) 


\ismi 


r-sorf?.'! 


13040 

1301/0 

13060 

13070 

13080 

13090 

13100 

13110 

13120 

13130 

13140 

13150 

13160 

13170 

13180 

13190 

13200 

13210 


1 + AST( I>3^ NO) +X1 11) )«2, 

T1 ( T.3 ) = (iS:T t I# IjNu) VXi(2)-AiT( I»2»N0)<=Xi( i) 
l-AST(Tt^»^’f')«xl{4))*2. 

T1(T#4) = (-aST( I,1>N0)*?X1(I)-AST{1»2xN0)<'X1(2) 
1-AST(I#3.N0)«X1 (3) )^2. 

165 COMTINUF 

DO 166 K = lf4 

TAd t^OsTl f I,K) /SwPl (1 .~U(1)=«‘*2> 

TA(?»K)=-n ( 3#K) 

166 CnNTTN.UF . - 

nn ISO J=lt3 

H«ftTn» J)=0, 

HMAT(2»J)=0. . 

nn IPO K=l,4 

M.maT{ 1> J)=HMAT{1* J)+TA(l,K)*TT{Kx J) 

HMAT(?> J )=HMaT( 2# vD + TAta^K)*! T(K» J) 

180 rnNTTKUB 
RETURN 



1322P 

13230 C 

13240 C 

13250 

13260 C 

13270 

13280 

13290 

13300 

13310 

13320 

13330 

13340 

1335C C 

1336C C 

13370 

13380 C 

13 390 C 

13400 

13410 

13420 

13430 

13440 

13450 


ENO 


SUBPnUTTNr Rr,AT 

FORMS MEASUREMENT NCISE COVARIANCE MATRIX 
CnMMDN/5/SSV(27>2)j PP{3)>B(3x3r2) 
CnNMnN/6 /NTP, JCATiNOjYL (2#2) 

COMMON/fi./P {7,7)>k{2>2)^ AK{8>2)>HMAT(2^7) 
Pn»2)=P(2>l)=0, 

R(1»1)=SSV( 6jiN0)^’i‘2 
P(?;2)=SSV( 7,NG)4«2 

RETURN 
FNO 


SU4RTUTIMP FILT 

USING MALMAN FILTER’ EOS.# COMPUTES FILTER GAlNS#AKi AND PROPAGATES 
Fopnp nVARTAiNlE hATRIX^P 
rriMMow/i/MG» NDELP# NM 

CfiM«nNj/p/PTMb( 12)#TAU(3>6)»WM(o)»DRfT(6)»GY(9,6) 
roMnnw/A/DHTi ),hhI2 (4,3)jO(7j 7)# U0(4,6) #WP( 3j2) »RP«4j4) 
CnMvnH/<i/^c;u(27>2}>PP{3)^a(3»3#2) 

CnMMnK,/p/p(7,7),F (2^2)/AK(v;»2)>HnAT(2>7) 

TA(7#7)d8t7) 
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13^00 C 

13^70 

X34o0 

1349C 

13500 

13510 

1352C 

13530 

135^0 

1355C 

13560 

1357C 

13560 

13590 

13600 

13610 

13620 

13630 

136'^0 

13650 

13660 

13670 

13680 

13690 

13700 

13710 

13720 

13730 C 

13740 

13750 

13760 

13770 

13760 

13790 

13800 

13810 C 

13820 

13830 

1384C 

13050 

13860 


COMPUTE additional CuNSTAMS t-OR PARTITIONING MATRICES 
MM7 = f,|MI 

MS:? =MK'T -»'M2 
N = NM+3 
M = ? 

CHI SRM«Ul { PHllj 1# l»3»3»Pil^ 1»3; TA»1#1 j4^7#7> 

CALL SPf''wUL(PHI2>l,l,.3>NN2AP?4,l?3,P>ijl/4#7#7} 

CALL SPWAOni TAii, 1,P>1j1jTA,1j1,3# 3» 7#7#7) 

CALL 5PM'^UL(PhIl,l»l/3j3>Pfl^4#NN2#TA,l,if,Ai7»7} 

CALL SPMMHL(PHi2^ j»1^3>NN2/Pj4>4vNN2».P»l* ^#4#7#7) 

CALL SP»^AnO( TA»i^4,P,l#4, P,l>4» 3i NN2#7>7>7) 

CALL SRMMUL(PHll»l»l»3,3jPil#4 + NN2^NN3^TA>:^4-HNN2>4»7»7) 
CALL «P«MUU HHI2, 1,1,3# NN2i P/A^A + NNZ^NNS# Pj? l,.4 + tSN2# 4, 7, 7 ) 
TTs4+MMP 

call SPMAnD(TA,l,il,?,l,Il,P, 1, I1,3,NN3,7,7,7) 
nn 15 T*=l ♦ 3 
nn 15 K=l,3 
P( T,K )=0. 

nn 15 J=l,3 

15 P( I,K )=P( T.K J+TA( I, J)«PriIl(K, J) 
no ?0 T=l»3 

m 20 K = l,3 , 

TAtIiK)=0. 
nn ?0 J=1,NN2 

20 TA{T,K)=TA{I,K) + P(I,J+3)^PHI2(K, J) 

CALL SPMAOnc 1,TA,1,1,P,1, 1,3, 3, 7, 7, 7) 

CALL SPN’TPAf P, 1,4,3,NN2,P,4,1,7,7) 

CALL SP‘^TPA(P.1,4 + NN2,3,NN3,P,4 + NNZ,L,7,7) 

P=PMT p PHI-THANSPOSfc has BEEN COMPUTED 
CALL SPMAnn(p,l,l,Q,i,l,P,i,l,N,N,7,7,7) 
pptUPN 
ck|tpy '^FIIT 

CALL SPMMUL (HMAl ,l,l,M,N,P,l»i,N,TA,l,l,2,7,7) 
call ?PMTPA(hMAT,l,l,M,N,AK, 1,1,2,8) 

CALL ’JPN'MUL rTA,l,l,M,N,AK,i,i,M,TA,H + i,l,7, 8,71 
CALL S'- MAnD(TA,M+l,i,fi,l,l,TA,l,l,M,H,7,2,7) 

TNVFPSP POUTiNE FCLLQWS 

nET = TAn,l)*IA(2,2)-TAl2,l)’PTA(l,2) 

T* (1 . »^ + l ) = TA (2,2 l/DET 
TAH ,«+?)=-Ta( 1,2)/DET 
TA(p,M + i )=~T4 (2, 1 )/DET 
TA(?,A’ + ?) =TA (i,l)/DEr 






r '■" - t 


U - 


13870 C 
13860 
13890 
13900 C 
13910 
13 ?2C 
13930 
139^0 
1395 0 
13900 
13970 
13980 
13990 
1^000 
l<i010 
1^020 
1^030 
14040 
14050 
14060 C 
14070 
1^080 
14090 
14100 C 
14110 
14120 
14130 C 
14140 C 
14150 
14160 
14170 C 
14180 
14190 
14200 
14210 
14220 
14230 
14240 
14250 
1426C 
14270 
14280 


FND HF TNVFRiE PGLTIiNt 

C4LL » i^f'. + lih^TA^ 1^ 1> 8^#71 

CALL (H,i,i,N»N»TAji#l/M#AK»l,l#7, 7i8) 

AK HAS 8FFM COMPUTtD 
OP 45 1=1, M 
nn 45 K=1»M 
TA(I,K)=0. 
pn 40 J=1,M 

40 TAd.X) = TA(1,M-AK{I,JJ<'HMAT(J,K) 

If* (I.^T.K) vaO 10 45 

TA(I,K) = 1,+TA(I,K) 

45 CnKJTINL'F 

on 55 1 = 1, N .. . 

pn 5c 1^ = 1, N 
T'»('^) = 0, 

on Ko j = i ,N _ 

50 T8(K)=TP{K) + TA11, J)»PU,K) 

OO 55 K=1,M 

55 TA(I,K)=Tn(K ) . . 

SYH'<FTPI7e PkRuP covahiance matrix 

pn 60 T=1,M 

pn 60 J = 1,N 

60 P( I, J)=0.54‘{lA(i, J)+TA( J, I ) ) 

p(K+i ) HAS RfctN Computed 

RETURN 

FNO 


SUBRnfJTlf'F <:RMMbL(A, lMA,INA,f1A,NA, B,1MB,INU,NB,C,IMC,INC, IRA,1RB> 
IIPC) 

C = A^P WITH TtsIT. ARRAY tltHENTS SPECIFIED 

-lAPHSinN A(49),8(49),C(49) 

on 5 1 = 1,'* A 

TotMC = T+T«C 

IPTMA = I+T^A 

IF (NO.L T,1 1 G3 TO 6 

nn 5 K=l»No 

KPTWr = K + It^'C 
KPJNrs = V + T’^'!i 

Xr - TPT«r-■i + (^FI•'.C-2)■^^RC 
r ( TP) = 0. 

TP (MA.lT.l) GO ID 6 
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1^290 5 J=1 .NA 

1A3C0 JOT^’& = J4-TNA 

1931G JPIMfi = J + T*^b 

19320 TA = TPTma-1 + UF1NA-2)«IRA 

19330 T« = JPTMB-l + (KPINB-2 

1939C 5 C(TC) = C{TC) + A(iA)=ifanB) 

19350 6 RPTUPM 

19360 

1937C C 

19360 C 

19390 SimPqUTINF SRMADDtA, IMA, iNAj B# Ifia, INB , C , I MC # I NC , M , N , IR A, IRB, I RC ) 

19900 C C=A+A WITH TMXT. aRRAV ELEMENTS SPECIFIED 

19910 DTMFMSICM A ,t 99 ) , B 1 99 ) , C ( 99 ) 

19920 09 5 t=i,m 

19930 TF (N.LT.l) GO TO 6 

19990 . 0^ 5 J'1,M 

19950 IPTMC = I+IMC 

X9960 JPINC = J+TMC 

19970 TPIHA = I+IMA 

19980 JPJNA = J+TNA 

19990 TPIMP = T+T'«B 

19500 JPTNR = J+TMB 

19510 lA = ‘TPTMA-l+( JPINA-2)=!'IRA 

19520 IB = TPIMB-1 +( JPINB-2)«IR3 

19530 IC * TPlHC-l+( JP1NC-2)*IPC 

19590 5 C(TC) = M Ifi )+B (IB) 

19550 6 RFTUPN 

19560 ENO 

19570 C 
19580 C 

19590 SUBRnUTINP SR MTR A ( A, IMA , IN A, M, N, B, I KB, 1N6, IRA, IkB ) 

19600 niMPNSTPN A(99),Bt99) 

19610 C R=A-TOANSPnSt WITH INIT, ARRAY ELEMENTS SPECIFIED 

1962C TP (N.l T.l ) GO TO 6 

19630 DO 5 1=1, N 

19690 DP 5 J=1,M 

19650 TPTMB = I+TWd 

19 66C JPTWR = J + 7'"b 

19670 JPI'^A = J + Jma 

19bbO TPINA = T + TK’/; 

19690 TA = JPT^A-H C iPlkA-2 )«IRA 

19700 TP = TPI«”-1+( JPlNa-2)=IRE 

B-28 





1A710 

1^720 

14730 

14740 

147&0 

14760 

14770 

14760 

1479C 

14800 

14810 

14820 

.14.8.30 

i4840 

14860 

14860 

14870 

14900 

.14910 

14920 

15020 

15060 

15080 

15090 

15100 

15110 

15120 

15130 

15140 

15150 

15160 

15170 

15180 

15190 

15200 


{3^ E^iS 


UaS#} !:>»*») i.i#IWL] 


f:^] lHi!0 SI® ^fe] 


5 B(I8)=A(IA) 

6 R'‘T(1PM 

pwn 

C 

C 

SUBPnuTjN'E PUPIL 

C UPOATFS ATTTTUDL VARIABLES AND OTHER SYSTEM ELEMENTS OF THE 
C STATF '/FCTHO 

CnMMnM/i/MG,NDELP#NNi 

C n M wn N / ? / T T E # T 0 > T e > D E„L r j K DEL I ».X.l 14J.#.X 1 1 i.4 J 

CnMM0N/3/5>TMu(12)5TAU( 3#6) jWM(6)#DRFT(6)iGY(9j6) 
C0NN'nN/5/SSVC27j2)#pP (3),B(3,3»2) 

C^M^1n^f./7./Y.n(.2,^), Y.(.2i.2).#.Ua^J^ ASTt3^'^#2.lj?S.TB(..3,.2). . 

Cn«MnM/8/P(7, 7)^Rt2^2) # AK(8»2)7HMATI2#7) 

OTMFNSinw Wf3)>T(3) 

Wfl) =70(1,’) -YD ( 1 ^ 1 ) 

W(?)=Yh(?,?)-YD(2,l) 

C COMPUTE CQRPtCTION FOR EACH SYSTEM PARAMETER OF STATE VECTOR 

on 11 T=1,NM1 . _ ... 

W(3) = AK(T+3,l)«W(i)+Ak(i+3,2)*k(2) 

PIMU( TlsPTMU { 1)+W(3) 

11 C^NTTNUF _ _ _ . 

C COMPUTF CDPRECTiONS FOR EACH ATTITUDE VARIABLE 

DO 9 1=1,3 

T(I) = AK(I,l)>t'iy(l)+AK(I,2)*Wl2) , . . 

9 CONTTNUF 

C UPDATE ATTITUDE VARIABLES 

XI (4)=X1 (4)-iXl(l)*T(l )+Xl (2)^‘T(2)+X1(3)*T(3) )/Xl(4) 

on 10 1*1,3 
X1(T)=X1(T)+T(I) 

10 CONTINUE 
PPTLM?*’ 

PNO 

C . . 

c 


W. 
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OulOO 

oouo 

00120 

0012b 

00130 

00140 

00150 

00155 

00160 

00170 

00180 

G0190 

00200 

00210 

00220 

00221 

00222 

00223 

00224 
00230 
00240 
00250 
00260 
00270 
00280 
0029C 
00292 
00294 
00300 
00310 
00315 
00320 
00330 C 
00340 C 
00350 
00360 
00370 
00360 
00390 
00400 
00410 
00420 


PO0GI?Ar DTAo EDI INPuTjUUTPUT# TAPED 
rn^MPf A (300,3)iN(30J) # Lr-UE 
PTMEMST^M P{3) 

Dpy fKtn 1 

T=0 

10 I=T+1 

RPAn(l,6) A <lDDAU>2)#A(Ji3)^NtI) 
A(T,3 )=SCPT(a(I#2)**2+A(I.3)*»2) 
fc FnP'^AT('^( tli.6) j2X, U) 

TF(FTFD) 20 , lo . . . .. 

20 rnNTTNL'F 
LPILF=I-1 

ACCFpt Ml _ 

PPTMT 5, Ml 

2 FnRMAT(X»PHPUN NO. D2) 

nn TOP Ll = ?» 3 

PPTNT 7, LI 

7 FnR«AT( //X,Ti, X,12riAXl5 RESULTS/ 
122X»3HA.V,» 5Xj 3 HkSS#4Xj 4HPEAK/ 1 
CALL AMAL(«.1^L1) 

PPTNT 3,{R(I)#1=1#3) 

3 form aTH ftriPSTINAT.IOJl. ERROR ^ 5X> 3 ( F 5 . 2j 3X ) ) 
CALL ANAL(B>2,L1) 

PPIh'T 4DR(T)#1»1^3) 

4 FORMATHTHFIL TER CONF IDENCE> 4X# 3 ( F5. 2^ 3X )) 
CALL ANAL(B»3>ll) 

n*' 30 T-l»3 

30 (T) /4. c46E“o 

print 5> ( 3( I = l»3) 

5 FORMAT (14HMFAS. RES IOUAL> 7X j 3 ( F5 , 2^ 3X ) ) 

100 CflNTTNUF 

ENO 


SUBROUTINE ANAL(B#K#L1) 
COMMON A(300#3)>N(300)#LFILE 
OIMFMSTOM B(3DC(200j2) 

T = 0 

pfi 50 J=1,LP1L£ 

TP{N(,n.MP.K) DU TO 50 
T = T + 1 

C(X»1)=A( J,1S 


1 gaBifel ■? 

i ! 

1 t 


00^30 


C(T^?)=A( Jill) 

004^0 

5C 

C'^NTTNUF 

OO'^tSO 


II 

\ 

OCAbO 


S-SMttO. 

0C^70 


T0=C(T»] )“C{1,1) 

00<t80 


S^’X=C (1>21 

00490 


DO 30 J-1.T1 

00500 


T=C(J+1,1 )-r ( J,1) 

00510 


X?=C(J+1»2) 

00620 


X1=0{ 

00530 


S=S+(Xl**?+X2**2+Xl»X2)*T/3 

00540 


SM=SK+T*{Xl+X2)/2. 

00550 


TP{X?.LT.SHX) GD TO 30 

00560 


SMX = X2 

00670 

3C 

ff^NTTNUF 

00580 


P(1)=SW/T0 

6o590 


i^(2)=sopt(<:/t6j 

00600 


B(3)=SMX 

00610 


PETUOM 

00620 


END 
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1.0 


INTRODUCTION 


The IRU(OAO) is a three-axis strap-down inertial 
reference unit that was designed and built by the Charles 
Stark Draper Laboratory (CSDL) under contract with NASA's 
Goddard Space flight Center fCSI-C) for their Orbiting 
Astronomical Ob servant ory . The IRUCOAOl hngineering Model was 
built in 1968, iv-ent through qualification testing in 1969 
and was delivered to GSFC in March 1970. Since then it has 
been modified and used by GSFC to demonstrate various concepts 

Early in 1975 consideration was given to using the 
Engineering Model in a concept evaluation program to be con- 
ducted with the TRIV Precision Attitude Determination System 
fPADS) . In mid-April 1975, GSFC contracted with CSDL for 
the following efforts : 

1. to evaluate the current performance and operating 
characteristics of the Hngineering Model 

2. to assist with the integration of the unit with 
the PADS if the first item shows the Engineering 
Model to be in satisfactory operating condition. 

This report describes the first effort. Two trips were made 
to GSFC in support of the first item. The first trip was made 
from 7-10 April 19 75 to iiu'estigate the modifications made by 
GSFC to the Engineering Model. The second trip was made from 
20-23 May 1975 to take data from the system. A brief summary 
of both trips is included in Section 3. Section 4 contains 
a summary of the result for data accumulated from 20-28 May 19 
The conclusion and recommendations are reported in section 2. 






2.0 


CONCLUSION AND RHCOMIll-NDATIONS 


The Engineering Model of the OAO-IRU is not operating 
properly. This is apparent from several system malfunctions 
during testing and the results of the data accumulated. 

Assuming, however,, that the system does not degrade further, the 
following performance capabilities are feasible if the system 
is continually updated at 30 minute intervals or less, 

1. Roll Axis - One sigma angle uncertainty 

< 1 arc-second. 

2. Pitch Axis - One sigma angle uncertainty 

< 2 arc-seconds. 

3. Yaw Axis - One sigma angle uncertainty 

< 10 arc-seconds. 

Because of abnormalities in the system data 
obtained (especially for the yaw axis gyro) , history of system 
malfunctions, and the possibility of future malfunctions or 
failures, CSDL recommends that GSFC does not send the OAO-IRU 
Engineering Mdocl to TRW for integration with the PADS system. 

It is believed that there is an intermittant failure either in 
the Precision Power Supply or Ivlieel Power Supply within the 
Electronics Package, fl’owevor, identifying and correcting such 
a problem could be quite time consuming and unfortunately is 
beyond the scope of this contract. 
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3.0 


SUMMARY or EVENTS 


The first trip was made to GSFC from 7-10 April 
1975. The purpose of this trip was to investigate a possibio 
module failure and become familiar with the modifications made 
by GSFC to the OAO-IRU Engineering Model. The suspect module 
was an MH-7 type which supplies the gyro’s signal generator 
excitation. This module was found to be defective and was 
subsequently repaired by externally wiring a set of transistors 
to replace the defective ones within the module. This same 
procedure \v^as previously used on an MH-3 type module that 
provides the suspension excitation. There was no apparent 
reason for either of these modules' demise. It is known however 
that the MH-3 module will self-destruct if it loses a reference 
frequency from the precision power supply in the electronics 
package. Another possible malfunction in an MD-10 type moviuh* 
was also noted (k-Term Pulse Generator). However, since this 
failure should not affect PADS testing it was not pursued. All 
repairs were made by GSFC technicians. 

After the above repairs were made to the system, a 
second trip (20-23 May 1975) was made to obtain data from the 
IRU. The system was turned on and data acquisition was started 
at approximately 9 pm on 20 May 1975. At approximately 6 am on 
21 May 1975 the system went into the ISTAB mode with a 
continuous - angle- reset commanded. This is symptomatic of a :{v:e:ita 
loss of power. Tlie system was reset at approximately 9 am and 
ran for approximately 8 hours before the same thing happejied 
again. The power supply in the Ground Support Equipment which 
supplies the prime power to the IRU was then replaced and data 
was accumulated from Wednesday night until Thursday morning 
(21-22 May). No problems occurred during that period. 

During Thursday the system was shut down for modification 
to the IRU- PADS data interface. After those modifications were 
completed, the system was turned on with the IP- load panel 
(gyro package simulator) and the electronics package checked out. 
Once, while in this configuration the system went into the ISTAB 
mode with a continuous angle reset commanded. Also while in 
this mode a second anomalous behavior was observed. Ifnen the 
dummy wheel load was cycled on and off, the system power would 
frequently (approximately 50 1 . of the time) increase by 60 wa-ts. 
When this happened, the only noticeable effect was a 3 to 4 
volt drop in the 45 volts which is used for the gyro torque 
loops. On Thursday pm (22 May) the IRU was again turned on with 
the Inertial Package and data ivas accumulated until 2:30 pm 
on 28 May 1975 without any further visible abnormalities. 
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4.0 


SUMMARY OF RESULTS 


Two types of data were accumulated during the period 
from 20-28 May 1975. 

(1) Long Term Stability data where the not number 
of rebalance torque pulses were calculated and 
recorded every 2.56 or 20.48 seconds. 

(2) Noise Equivalent -4ngle data where each 5 
millisecond rebalance pulse was recorded. 

4*1 Long Term Stability Data 

Three sets of long term data were recorded for each 
gyro. The periods over which each set of data was taken aro 
listed below. 

(1) Set 1 9 pn> 20 May to 9 am 21 May 1975. 

(2) Set 2 9 pm 21 May to 9 am 22 May 1975. 

(3) Set 3 11 pm 22 May to 2:50 pm 28 May 1975. 

Figures 1 through 5 show the results of set 1 for the 
roll, pitch, and yaw axis I'cspcctivoly. Tills data was proccssr-il 
by calculating the average rate every 71.68 seconds. Figure 
4 is the output of a tiltmeter whose sensitive axis was about 
a NW-SE line. 

These plots reveal the following; 

(1) *Rate impulses in the roll axis output that occur 

every 1/2 to 1 hour and have a magnitude of 0.2 
to 0.3 menu. 

(2) Several small changes in level (0.1 to 0.2 menu) and 
one large change of about 0.5 menu in the pitch 
axis . 

(3) Very erratic behavior of the yaw axis with peak- 
to-peak changes of 1.5 meru. 

(4) The tiltmeter data is quiet and well behaved thus 
eliminating base motion as a source of the 
gyros' behavior. 

Figures 5 through 8 are the results of data set 2 and 
were processed as set 1. Again each instrument has its own 
unique behavior. Figure 9 through 11 are the results of data 
set 3. This data is a graphical presentation of the average 

* This data without the presence of the rate impulses is 

characteristic of the performance of each instrument when the 
IRU is operating properly. 
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rate over every 675.84 seconds. The spikes in fig 10 (pitch 
axis) are a result of a data acquisition malfunction. This 
data again is consistent with that previously obtained even 
though no visible system malfunctions occurred. Data sot 3 
also shows the following long term characteristics of each 
instrument. 

(1) The roll gyro is fairly well behaved except for 
the existence of rate impulses (.2 to .3 meru) 
occurring every 1/2 to 1 hour. 

(2) The pitch gyro exhibits discrete changes in the 
rate output with a peak amplitude of 1 meru. Those 
changes are very regular and have a periodicity 

of ~ 16 hours. 

(3) Tb<=* yaw gyro is extremely erratic with peak to 
peak changes in rate of approximately 7.5 meru. 

4 . 2 Noise Equivalent Data 

As mentioned above, this data was recorded every .005 
seconds. To fulfill contractual requirements, 40 samples were 
summed to yield .200 second samples. This data was then 
processed to determine the best fit (least squares) attitude for 
each 50 minute segment of the data. Tables 1-5 show the peak 
and one sigma deviation of the .200 sec data samples from the 
best fit data for each 30 minute segment of the roll, pitch 
any yaw axis gyros respectively. These data are consistent 
with Long Term data; especially the erratic behavior of yaw gyro. 
The deviations for each 30 minute segment are graphically shown 
in figures 12 through 14. This data was plotted by sampling 
the deviation from the best fit every 36 seconds. 
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THE ABOVE DATA WERE PROCESSED BY SLIDING AN 
AVERAGING.// . v‘ > . SECOND CONTINUOUS DATA 
samples THE APPROXIMATE FILTER CHARACTERISTICS 
DERIVED ARE; 
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THE ABOVE DATA WERE PROCESSED BY SLIDING AND 
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THE ABOVE DATA WERE PROCESSED BY SLIDING AND 
AVERAGING - V SECOND CONTINUOUS DATA 

SAMPLES. THE APPROXIMATE FILTER CHARACTERISTICS 
derived ARE; 
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THE ABOVE DATA WERE PROCESSED BY SLIDING AND 
AVERAGING . SECOND CONTINUOUS DATA 

SAMPLES. THE APPROXIMATE FILTER CHARACTERISTICS 
DERIVED ARE; 
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THE ABOVE DATA WERE PROCESSED BY SLJ01i>iG AND 
AVERAGING SECOND CONTINUOUS DATA 

SAMPLES. THE APPROXIMATE FILTER CHARACTERISTICS 
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THE ABOVE DATA WERE PROCESSED BY SLIDING AND 
AVERAGING,.;) , i > SECOND CONTINUOUS DATA 
SAMPLES. THE APPROXIMATE FILTER CHARACTERISTICS 
DERIVcD ARE: 
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THE ABOVE DATA V;ERE PROCESSED BY SLIDING AND 
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SAtsflPl,ES. THE APPROXIMATE FILTER CHARACTERISTICS 
DERIVED ARE: 
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THE ABOVE DATA WERE PROCESSED BY SLIDING AND 
AVERAGING .4 , ..1 • i v SECOND CONTINUOUS DATA 
SAMPLES. THE APPROXIMATE FILTER CHARACTERISTICS 
DERIVED ARE: 
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THE ABOVE DATA WERE PROCESSED BY SLIDING AND 
averaging SECOND CONTINUOUS DATA 

SAMPLES. THE APPROXIMATE FILTER CHARACTERISTICS 
DERIVED ARE: 
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THE ABOVE DATA WERE PROCESSED BY SLIDING AND 
averaging .<?■ - SECOND CONTINUOUS DATA 

SAMPLES. THE APPROXIMATE FILTER CHARACTERISTICS 
DERIVED ARE: 
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THE ABOVE DATA 

SaSlS the APPROXIMATE FILTER CHARACTERISTICS 
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THE ABOVE DATA WEF^E PROCESSED BY SLIDING AND 
AVERAGING i J i SECOND CONTINUOUS DATA 

SAMPLES. THE APPROXIMATE FILTER CHARACTERISTICS 
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THE ABOVE DATA WERE PROCESSED BY SLIDING AND 

averaging :'..! , i: second continuous data 

SAMPLES. THE APPROXIMATE FILTER CHARACTERISTICS 
DERIVED ARE: 
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THE ABOVE DATA WERE PROCESSED BY SUDI\'G AND 
AVERAGING ; > . v* SECOND CONTINUOUS DATA 

SAMPLES. THE APPROXIMATE FILTER CHARACTERISTICS 
DERIVED ARE: 


\ (-2) Effective Biindwidlh 
rad/s 

SKd»Pt»t K IkST I.AdOtt/UOHY/Bl orOMO rL»OHT FACILtTY 






«AC SEC 



MIMI-ntORC ORO IWU TCSr CHPWMEL m tilt METen 
HRr 21 TO HR'f 22. 1975 nUM 056 




RefeoeNCE vrlue 1.0390000 

MERU 3.0783632 

StCiHR .0725U 

TOE WO .01796 

5ffi«n/TREW0 .03369 

RVErCiOtNG- fERlOO 71.63 
Ot.ErTEi) r-niNT5 2 Ol'T Hf p?3 
n56H tj 


r10Ufl5 

ROC 3EC 
PRC SEC 
PRC 5EC 
PRC Cf.r.ROlJflS 
PR" Zt" 

^r.f v“ 



THE ABOVE DATA WERE PROCESSED BY SUDitVIG AND 
AVERAGING - >' . v SECOND CONTINUOUS DATA 

SAMPLES. THE APPROXIMATE FILTER CHARACTERISTICS 
DERIVED ARE: 



Effective Bundwidih 
riid/i 


K IhST l..M;OnATOHy;riL uroMO r LIGtfi facility 
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ROLL AXIS 


:,i qwjkel ml rw;< dso-jru test 

MRr 22 TO Hfir 28. 1975 05FC RUN 059 


20.48 5EC/5aMPLE5 







trr 

UJ 

2: 




o 
■— < 
I 


r 


T 


0 L2 2U 


"T ! I i ! ] 

3S tiS GO 72 . ati 9G 

HOURS 


REFEREWCE VALUE 

MEAN 

SCGHfl 

TREND 

STfiMR/TREND 
HVt NC- PERIOD 
REJECTED P0rWT5 0 
HfWMY 059M L 


53.000000 
54.537259 
.1272 
.003274 
.00302 
675.04 
DOT OF 52 2 


MERU 

HERO 


MERU 

MERU /HCUR5 
KEhU 
5ECn:JD5 
ShMCLES 


l-iil 9 


5C5 TEST LflB 25K 6/4 /TS 8V 






HlMl-mORC CHftNMEL H2 TWY GPO-IP.U TEST 20.48 5EC/5RMf*LE5 
me 22 TO HRY 28. L975 G5FC RUN 059 


PITCH AXIS 


Data Acquisition System 
Glitches 


REFERENCE VfiLUE 

-780.00000 

MERU 

HERN 

-782.00962 

MEP.U 

5IG«fl 

1.6393 

P.ErUJ 

TREND 

-.01613 

/HOURS 

5tG«R/TREND 

I . 5928 

• H':r.U 

RVERRarWO EERIOD 

675. S4 

5Et:cWD5 

RE.itCTEO POINTS 49 

OUT OE 5tl 

5hKfLE5 

MlNNr 059M 2 
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MlNl-MIORC CttflMNEL M3 TWif CRO-IRU TE5T 20 
MRY 22 TO MRY 28. L975 G5FC RUIJ 059 


YAW AXIS 


HCUR5 


MERIJ 

keru 

MERU 

MER'J 

r.Er.'J 


-720.00000 
-722. 35223 
1.952II 
-.C189W 

675. fill 
OUT Of 5Ll 
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5IGMR 

TREND 

5rr.:5R/TRENO 
RVEFRGtNG PER TOO 
REJECTED POINTS 0 
MINKIY 059M 3 


/t:7oR5 


535 TEST LP.a L5K 6n/75 


trend PESIDUE (Ai^CEEC) 

(MERU) N’AX N’Ki SIC‘-‘A 


b YkO 

RUN 

UJMbER 

KvL 

Cb4 

1 

RJL 

Uo4 

2 

Ri.L 

0t>4 

5 

C ^ 

C j4 

4 


0 o4 

b 

R(.L 

C04 

6 

Rv.L 

ur>4 

7 

RoL 

vj 

tt 

ROL 

0:^4 

9 

Ri L 

Co4 

iO 

RCL 

u ^4 

11 

R-_L 

U j4 

J.2 

Rv.L 

0t34 

13 

HwL 


14 

K ;L 

Ul»*4 

lb 

KOL 

Co4 

16 

ROL 

Co4 

17 


SEoV.ENT 


POINT 

TIME 

COUwT 

(MINUTES) 

92 lo 

30.720 

92lo 

30.720 

9216 

30.720 

92 1 o 

30.720 

92 lu 

30.7 ;n 

92 lo 

30 . 720 

9216 

30.720 

92lo 

30.720 

'■:>216 

30.720 

?2 1 o 

30.720 

92 lo 

30.720 

92 lo 

30.720 

9216 

30.720 

921o 

30.720 

92 lo 

30.720 

921 o 

30.720 

92 lo 

30.720 


53.696 

0.307 

o3 . 665 

0.411 

03.719 

0.726 

53.708 

0.462 

o 3 . 7 1 j 2 

0 . 556 

53.7b2 

0 . 63fi 

03.725 

0.494 

53 . 635 

0.549 

53.759 

0.757 

03.719 

0.396 

53.736 

0.451 

53.730 

C.441 

53.736 

0.569 

o3.740 

0.2 53 

53.748 

0.253 

:j3.7J7 

0.590 

03.793 

0.516 


1 


-0.455 

0 . 102 * 

-0.366 

117 t 



— 0 • 1 > rf 3 

'.lobj 

-0.440 

0.K3j 

— C • 4o7 

i-*ii 

-0.574 

z.Jbrvi 

-0.396 

). 

-0.590 

» ' d 1 ; 

-0. 3^:4 

0. ii.2!i 

-C.607 

) . 1 tj 

-0.449 

■:< . 14C.' 

-C.317 

*. U:7': 

-0 .727 

. 1 

-C • 515 

. 1 llii 

-0.450 

•'i . I47l! 

1 

o 

• 

0. ir iJ 


RECORDED FROM: 9 pm 20 MAY -- 6 am 21 MAY 1975 j 

'n 


TABLE I 


RESIDUE (AOCSEC) 

MIM SIGVA 


-0.26° 0.092 


oYkO 

RUN 


NUMBER 


PIT 

0‘j7 

1 

PIT 

0o7 

2 

PIT 

0^7 

3 

PIT 

057 

4 

PIT 

0:>7 

5 

PIT 

057 

6 

PIT 

0^7 

7 

PIT 

057 

6 

FIT 

Cd7 

9 

PIT 

bo7 

10 

PIT 

0d7 

11 

PIT 

Uo7 

12 

PIT 

) ) u- 

0 


segv.ent 


POINT 

TIME 

COUf4T 

(MINUTES) 

9216 

30.720 

9216 

30.720 

92lo 

30.720 

921o 

30.720 

921o 

3C.7?0 

921o 

30.7^0 

9216 

30.720 

92lo 

30.720 

921o 

30.720 

9210 

30.720 

9216 

30.720 

921 o 

30.720 

32o 

1 . Ufl7 


TREIJD 

(meru) max 


- 79.272 O.uOl 

- 79.371 0.323 

- 79.327 0.338 

- 79.355 0.491 

-779.410 0*665 

- 79*4o3 0*627 

-779.322 0.379 

-779.255 0.412 

- 79.305 0.944 

--,79.594 0.253 

-7/9.211 0.292 

-779.216 0.440 

-779.280 0.337 


-0.31" 0.09o 
-0.408 O.IC: 
-0.175 0.100 
-C.291 0.156 
-C.328 0.137 
-1.499 0.434 
-0.345 O.llF; 
-0.452 0.29U 
-0.516 0.12<^ 
-0.32" C.0r;8 
-0.30? 0.114 
-0.135 0.083 


RECORDED FROM: 10 am -- 4 pm 21 MAY 1975 

TABLE 2 
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(MF.RU) 
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921o ■ 

30.720 

- 2r .l7f> 

2 . 652 

-3. ’ -J? 

0:jo 
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3C .7^0 

~74.'G.i20 

3.332 

-r .331 

fi :> d 

3 

1 u 

36.720 

-y 10.099 

7.321 

-f; . •'f-'i 

Ij jj; 


Oilo 

3'J .720 

-'719.099 

0.762 

-5. : 35 


b 

V2 1 o 

30.720 

•0 

• 

1 

3.325 

-1 .5.12 

0i)3 

6 

92 lo 

3J.720 

- 2'*. 231 

n.oi 0 

-5.477 


7 

•r»21o 

30 . 720 

-719.044 

4.61 9 

-2.22<' 

OjiS 

o 

92 lo 

3U.720 

- .ir .169 

C . 3c9 

-4. Si 7 

0:ji 

g 

v21o 

30.720 

~1 c.' • 7h6 

6.035 

^ ^ ^ ti 

0t>3 

10 

V21o 

3J.720 

-72i .ES2 

0.P4 0 

-7.44^ 

o:>^i 

11 

92io 

30.720 

-72 ‘.24.B 

1.635 

-? . » 

i' Jo 

1 <1 

"2 1 u 

30 . 720 

-7^: .995 

r . 799 

-? • *'5i 


13 

92lo 

3U.720 

-72C.2j3 

1.517 

-"b* 3- 

t Jci 

l4 

0 2 1 o 

3n.720 

-7^>'. .641 

6.422 

-li . ■ 

C 

lb 

92io 

3 J . 7 2 0 

-721 .22A 

2.454 

-1 . -‘j/i 


16 

9216 

30.720 

-7cf .761 

4. ',26 

^ j7? 

U J j 

17 

9210 

30.720 

-72'' .662 

2.521 



RECORDUD FROM: 


11 pm 22 MAY -- 8 am 23 MAY 1975 
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DRO IW TEST C5EC 
ATTITUDE ERROR ROLL RXI5 
20 TO 21 HHY 1975 
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ir? 
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o 
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U> 
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DliVIATION bl-TWl-HN 0.2 SHCOXD DATA POIN’TS A.VI) 30 MiXUTr M-ST FIT MODFl 
THl: DEVIATIONS ARE SAMPLliD AT 36 SECOND IMERVAI.S. 
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V 1 

1 

1 

1 

1 

0 

I 

2 

3 

U 



HOURS 



HERN 


.02BI7928 

RRC50C 


5IGMR 


.19BU 

flnC5EC 


TflEWD 


-.005037 

RP1C30C 

. /t1ClJR5 

SrwiR/TREWD 

.ISRO 

RhC3EC 


SAMIM.E 

PERIDD 

35.00 

5Er.r::;:’5 


DEJECTED 

POINTS 0 

OUT OF B7l 

5K:-.r’LE5 



_T 
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••iR 12 

SS5 TEST LK3 15 K D.R.8. 
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ORO IRU TEST QSEC 
RTTITUDE ERROR 
21 TO 22 MRY 1975 
N5LU 


RtTCrt RXI5 


DEVIATION BETWEEN 0.2 SECOND DATA POINTS AND 30 MINUTE, BEST FIT MODEL 
THE DEVIATIONS ARE SAMPLF.D AT 36 SECOND INTERV/.LS. 


HGUR5 


MERH 

5IGRR 

TREND 

SIGRR/TRENO 
SAMPLE PERIOD 
REJECTED POINTS 0 


-.OOB869B93 

.2085 

-.01739 

.2St37 

35.00 

OUT OF 517 




RRC5EC 
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RRCSEC 
RRC-SEC 

secl-nds 

Shdplfs 


/HOUR! 


505 TEST LR3 15 N G.R.3. 
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RITITUDE EflFlDn 
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DEVIATION DETWEliN 0.2 SECOND DATA I’OINTS AN’D 30 MlNUTli, BEST FIT MODEL 
THE DEVIATIONS ARE SAMPLED AT 30 SECCLND INTERVALS. 


MEBD 
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RRCSEC 
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RfiCSEC 
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TO: 


R. Harris 


FROM: R. Carson 

DATE: 6 November 1975 

SUBJECT: OAO-IRU Engineering Model Data at TRV/ September 1975 

Approximately sixty hours of gyro data was obtained from 
the OAO-IRU Engineering Model at TRV/, Redondo Beach, California 
during September 1975. This data is displayed in both time and 
power spectral density plots. The time histories provide an in- 
dication of the overall instrument performance and the PSD data 
can indicate the performance that can be expected in a particular 
frequency range. A brief description of the data accumulated 
is enclosed. 

Time Plots 

Three data sets were recorded simultaneously for each of 
the three instruments and are shown in Figures 1 through 9 . The 
details of each set are described below: 


Data Set 

Run 

Sample Period 

Length of Test 

Date 

1 

72 

.32 seconds 

9 hours 

8-9 Sept 

2 

73 

2.56 seconds 

32 hours 

9-10 Sept 

3 

74 

2.56 seconds 

16 hours 

10-11 Sept 


It can be seen from the time plots that the output of each gyro 
is consistent from test to test. It should also be noted that the 
roll and pitch instruments exhibit approximately 0.1 meru jumps 
within three stable states . It is further observed that these 
discontinuities occur simultaneously and are quite deterministic 
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with an overall period of approximately 17 hours. The yaw gryo 
on the other hand is quite erratic with frequent spikes of ap- 
proximately 3 meru and occasional spikes greater than 10 meru. 
Needless to say, the erratic behavior of the yaw gyro and the 
discontinuities in the roll and pitch instruments are not 
considered normal. However this performance is an improvement 
by approximately a factor of 10 over that which was observed 
at GSFC in June. The roll and pitch gyros would be considered 
quite acceptable without the jumps. Again it is felt that the 
anomolous behavior of the instruments is the result of an un- 
known malfunction within the Engineering Model. 

PSD Plots 

The results of the PSD analysis are shown in Figures 10 
thr'ough 18. The data are plotted as single sided PSDs (i.e., 
all the energy exists in the frequency range of 0 to <») in 
rate and have units of ’'meru^/Hz'* . Selected portions of each 
of the three da'ca sets were chosen to characterize the instrument 
output under various conditions and different frequency ranges. 
Figures 10 through 12 are the PSD of approximately 1.5 hours 
from data set 1 with no discontinuities. Figures 13 through 15 
are the resultant PSDs of approximately 12 hours from data set 3 
with several jumps. Figures 16 through 18 shov; the PSD plots of 
the first 24 hours of data set 2. 

Each of the PS^* nas two distinct characteristics: a positive 

slope at the high frequencies and a negative slope at the low 
frequencies. The positive slopes are proportional to f^ and are 
attributed to quantization noise due to the sampling process. 

It will be noted that the levels of the PSDs calculated from 
2.56 second data samples (Runs 7 3 and 74) are eight ti.mes higher 
than those calculated using 0.32 second samples (Run 72). This 
is consistent with modelling quantization noise as a white process 
in angle and band limited at the Nyquist frequency of the sample 
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rate . The remainder of this memo will concentrate on the low 
frequency characteristics which are attributed to the gyros 
and to the system. 

Figures 10 and 11 illustrate the behavior of the roll and 
pitch instruments without the presence of jumps and compares 
favorably with previously obtained data with other 2FBG-6F 
gyros. Figure 12 further illustrates the erratic behavior of 
the yaw axis gyro. At the low frequencies, the PSD of the yaw 
gyro is approximately 100 times greater than those for the 
other two axes even though the data used to generate the yaw 
PSD plot did not include any spikes. Figures 13 through 18 are 
the PSDs of each instrument v;hen spikes or discontinuities 
are present. The deterministic jumps in each of the axes not 
only increases the magnitude of the PSD but also change its 
characteristics at the lower frequencies. 


RCC/alk 
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PSD Analysis 
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THE ABOVE DATA WERE PROCESSED BY SLIDING AND 
AVERAGING f/2 0 . iJ. SECOND CONTINUOUS DATA 
SAMPLES. THE APPROXIMATE FILTER CHARACTERISTICS 
DERIVED ARE: 

\ (-2) Effective Bandwidth 
0.014 rad/s 

SKIPPER K TEST LA90RATORY/BEDFORD FLIGHT FACILITY 


riGUKE 1 
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PSD Analysis 




HEFEhL'r.L Vfvj;!: 

; i: ^; .' 


I •. • ! J 

.' • • ♦i •- I 





THE ABOVE DATA WERE PROCESSED BY SLIDING AND 
AVERAGING///^', . SECOND CONTINUOUS DATA 
SAMPLES. THE APPROXIMATE FILTER CHARACTERISTICS 
DERIVED ARE: 


1-2) Effective Bandwidth 
0.014 fdd/s 
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THE ABOVE DATA WERE PROCESSED BY SUDSNG AND 
AVERAGING //J? . 3^ SECOND CONTINUOUS DATA 

SAMPLES. THE APPROXIMATE FILTER CHARACTERISTICS 
DERIVED ARE: 


V- . *• 


(-2) Fffectivc Bandwidth 
. ^ rad/s 
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THE ABOVE DATA WERE PROCESSED BY SLIDING AND 
AVERAGING ^'C d ,^.^6 SECOND CONTINUOUS DATA 
SAMPLES. THE APPROXIMATE FILTER CHARACTERISTICS 
DERIVED ARE: 

(-2) Effective Bandwidth 
0.00 35 rad/s 
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FIGURE 5 


THE ABOVE DATA WERE PROCESSED BY SLIDING AND 
averaging yi 0 . J.Sv SECOND CONTINUOUS DATA 
SAP/IPLES. THE APPROXIMATE FILTER CHARACTERISTICS 
DERIVED ARE; 

\ <-2) Effective Bundwidth 
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THE ABOVE DATA WERE PROCESSED BY SLIDING AND 
averaging <? . A-Sfl SECOND CONTINUOUS DATA 

SAMPLES. THE APPROXIMATE FILTER CHARACTERISTICS 
DERIVED ARE; 

\ (-2l Effective Bandwidth 
0.00 35 rad/$ 
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THE ABOVE DATA WERE PROCESSED BY SLIDING AND 
averaging yrc: . ZS'C SECOND CONTINUOUS DATA 
SAMPLES the" APPROXIMATE FILTER CHARACTERISTICS 
derived ARE: 
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Test Run No. 1 
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Strapdown System 
Test Run No. 4 


Figure D-4 
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Figure D-5 


Gimbal System 
Test Run No. 
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Figure D-7. Gimbal System 
Test Run No. 3 
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APPENDIX E 


FLOW DIAGRAMS OF LABORATORY COMPUTER PROGRAMS 
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SUE Program Flow Charts (1 of 7) 
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INTERRUPT 


INHIBIT INTERRUPTS 


SAVE REGISTERS 


ALLOW CLOCK INTERRUPT 


READ IN AA/C VOLTAGES 


READIN ABT ANGLE 


MODE 


COMPUTE REQUIRED 
ABT ANGLE 


COMPUTE ABT COMMANDS 


SEND DAC OUTPUTS 


INHIBIT INTERRUPTS 


RESTORE REGISTERS 


ENABLE INTERRUPTS 


SUE Program Flow Charts (2 of 7) 























CLOCK 

INTERRUPT 


INHIBIT INTERRUPTS 


SAVE REGISTERS 


ACKNOWLEDGE 
CLOCK INTERRUPT 


INCREMENT RAMP 
TIME COUNTERS 


INCREMENT RUN 
TIME COUNTERS 


ONE SECOND 
INTERVAL? 



INCREMENT 100 SEC 
COUNTER FOR GYRO 
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INTERRUPT 


INHIBIT INTERRUPTS 


SAVE REGISTERS 


ALLOW X, Y AND 
CLOCK INTERRUPTS 


READ IN SLOW 
INPUT DATA 


CONVERT GYRO DATA 


READ IN MODE SWITCH 
POSITIONS 


BEGIN FLAG 


SWITCH 

CHANGE 


STORAGE LAST SWITCH 
POSITIONS 


SUE Program Flow Charts (4 of 7) 












INITIALIZE NEW MODE 


SET BEGIN FLAG 


DATA COLLECTION 
SWITCH 


DATA FLAG 


DATA FLAG 


SEND START SIGNAL 
TO V73 


SEND SLOW OUTPUT 
DATA TO MODEM 


START CLOCK SET 
DATA FLAG 


ssjx/y 

STATUS 


SSTX - SSTDEF 
SET SST FLAG 


MODE 


SST 

STATUS 


SEARCH 


TRACK 


SUE Program Flow Charts (5 of 7) 
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1 SEC FLAG 


SSTFLAG 


LAST 1 SEC FLAG 
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FLAG 
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CONTROL 
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INTERRUPT 


INHIBIT INTERRUPTS 
AND SAVE REGISTERS 


ALLOW CLOCK INTERRUPT 
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MODE 


COMPUTE REQUIRED 
ABT ANGLE 


COMPUTE ABT COMMANDS 


TRACK 


TSFLAG 


SEARCH 
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SEND DAC OUTPUTS 


INHIBIT INTERRUPTS AND 
RESTORE REGISTERS 


ENABLE INTERRUPTS 
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CLOCK 
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CLOCK INTERRUPT 
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INCREMENT RUN 
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GST STATUS 


BEGIN FLAG 


SW'TCH 

CHANGE 


SLOW 

INTERRUPT 
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TRACK 


SAVE REGISTERS ALLOW 
X. Y AND CLOCK 
INTERRUPTS 


READ IN SLOW 
INPUT DATA 


SEARCH 


SEA BIT (BLC) » 1 
RESET TSFLAG 
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RESET TSFLAG 
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READ IN MODE AND STAR 
SWITCH POSITIONS 


STORE SWITCH POSITIONS 










INITIALIZE NEW MODE 


SET BEGIN FLAG 


DATA COLLECTION 
SWITCH . 


RESET 


DATA FLAG 


DATA FLAG 


ZERO RUN TIME 
COUNTERS 


STOP CLOCK RESET 
DATA FLAG 


SEND START SIGNAL 
TO V73 


•5TART CLOCK SET 
DATA FLAG 


SEND SLOW OUTPUT 
DATA TO MODEM 


MODE 


SEARCH 


GST STATUS 


TRACK 
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COMPUTE GSTE 


COMPUTE RUNNING 
AVERAGES 


OPERATION 
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SEARCH 


GST STATUS 
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1 SEC FLAG 
















FIRST TIME 


SET FIRST TIME 
FLAG 


SEND 14 WORDS 
TO V73 


SEND 20 WORDS 
TO V73 


ENABLE INTERRUPTS 
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